|
@@ -105,9 +105,24 @@ void of_dma_configure(struct device *dev, struct device_node *np)
|
|
|
ret = of_dma_get_range(np, &dma_addr, &paddr, &size);
|
|
|
if (ret < 0) {
|
|
|
dma_addr = offset = 0;
|
|
|
- size = dev->coherent_dma_mask;
|
|
|
+ size = dev->coherent_dma_mask + 1;
|
|
|
} else {
|
|
|
offset = PFN_DOWN(paddr - dma_addr);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Add a work around to treat the size as mask + 1 in case
|
|
|
+ * it is defined in DT as a mask.
|
|
|
+ */
|
|
|
+ if (size & 1) {
|
|
|
+ dev_warn(dev, "Invalid size 0x%llx for dma-range\n",
|
|
|
+ size);
|
|
|
+ size = size + 1;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (!size) {
|
|
|
+ dev_err(dev, "Adjusted size 0x%llx invalid\n", size);
|
|
|
+ return;
|
|
|
+ }
|
|
|
dev_dbg(dev, "dma_pfn_offset(%#08lx)\n", offset);
|
|
|
}
|
|
|
|