Merge branch 'linux-2.6'

2 files changed, 53 insertions, 3 deletions

diff --git a/arch/powerpc/kernel/iommu.c b/arch/powerpc/kernel/iommu.c
index 47c3fe55242f..a3c406aca664 100644
--- a/arch/powerpc/kernel/iommu.c
+++ b/arch/powerpc/kernel/iommu.c
@@ -278,6 +278,7 @@ int iommu_map_sg(struct iommu_table *tbl, struct scatterlist *sglist,
         unsigned long flags;
         struct scatterlist *s, *outs, *segstart;
         int outcount, incount, i;
+        unsigned int align;
         unsigned long handle;
 
         BUG_ON(direction == DMA_NONE);
@@ -309,7 +310,12 @@ int iommu_map_sg(struct iommu_table *tbl, struct scatterlist *sglist,
                 /* Allocate iommu entries for that segment */
                 vaddr = (unsigned long) sg_virt(s);
                 npages = iommu_num_pages(vaddr, slen);
-                entry = iommu_range_alloc(tbl, npages, &handle, mask >> IOMMU_PAGE_SHIFT, 0);
+                align = 0;
+                if (IOMMU_PAGE_SHIFT < PAGE_SHIFT && slen >= PAGE_SIZE &&
+                    (vaddr & ~PAGE_MASK) == 0)
+                        align = PAGE_SHIFT - IOMMU_PAGE_SHIFT;
+                entry = iommu_range_alloc(tbl, npages, &handle,
+                                          mask >> IOMMU_PAGE_SHIFT, align);
 
                 DBG("  - vaddr: %lx, size: %lx\n", vaddr, slen);
 
@@ -570,7 +576,7 @@ dma_addr_t iommu_map_single(struct iommu_table *tbl, void *vaddr,
 {
         dma_addr_t dma_handle = DMA_ERROR_CODE;
         unsigned long uaddr;
-        unsigned int npages;
+        unsigned int npages, align;
 
         BUG_ON(direction == DMA_NONE);
 
@@ -578,8 +584,13 @@ dma_addr_t iommu_map_single(struct iommu_table *tbl, void *vaddr,
         npages = iommu_num_pages(uaddr, size);
 
         if (tbl) {
+                align = 0;
+                if (IOMMU_PAGE_SHIFT < PAGE_SHIFT && size >= PAGE_SIZE &&
+                    ((unsigned long)vaddr & ~PAGE_MASK) == 0)
+                        align = PAGE_SHIFT - IOMMU_PAGE_SHIFT;
+
                 dma_handle = iommu_alloc(tbl, vaddr, npages, direction,
-                                         mask >> IOMMU_PAGE_SHIFT, 0);
+                                         mask >> IOMMU_PAGE_SHIFT, align);
                 if (dma_handle == DMA_ERROR_CODE) {
                         if (printk_ratelimit())  {
                                 printk(KERN_INFO "iommu_alloc failed, "
diff --git a/arch/powerpc/kernel/prom_init.c b/arch/powerpc/kernel/prom_init.c
index 1add6efdb315..5d89a21dd0d6 100644
--- a/arch/powerpc/kernel/prom_init.c
+++ b/arch/powerpc/kernel/prom_init.c
@@ -2216,6 +2216,45 @@ static void __init fixup_device_tree_efika(void)
                         prom_printf("fixup_device_tree_efika: ",
                                 "skipped entry %x - setprop error\n", i);
         }
+
+        /* Make sure ethernet mdio bus node exists */
+        node = call_prom("finddevice", 1, 1, ADDR("/builtin/mdio"));
+        if (!PHANDLE_VALID(node)) {
+                prom_printf("Adding Ethernet MDIO node\n");
+                call_prom("interpret", 1, 1,
+                        " s\" /builtin\" find-device"
+                        " new-device"
+                                " 1 encode-int s\" #address-cells\" property"
+                                " 0 encode-int s\" #size-cells\" property"
+                                " s\" mdio\" 2dup device-name device-type"
+                                " s\" mpc5200b-fec-phy\" encode-string"
+                                " s\" compatible\" property"
+                                " 0xf0003000 0x400 reg"
+                                " 0x2 encode-int"
+                                " 0x5 encode-int encode+"
+                                " 0x3 encode-int encode+"
+                                " s\" interrupts\" property"
+                        " finish-device");
+        };
+
+        /* Make sure ethernet phy device node exist */
+        node = call_prom("finddevice", 1, 1, ADDR("/builtin/mdio/ethernet-phy"));
+        if (!PHANDLE_VALID(node)) {
+                prom_printf("Adding Ethernet PHY node\n");
+                call_prom("interpret", 1, 1,
+                        " s\" /builtin/mdio\" find-device"
+                        " new-device"
+                                " s\" ethernet-phy\" device-name"
+                                " 0x10 encode-int s\" reg\" property"
+                                " my-self"
+                                " ihandle>phandle"
+                        " finish-device"
+                        " s\" /builtin/ethernet\" find-device"
+                                " encode-int"
+                                " s\" phy-handle\" property"
+                        " device-end");
+        }
+
 }
 #else
 #define fixup_device_tree_efika()