Changeset 1787e527 in mainline for boot/genarch/ofw.c

Timestamp:

2009-11-16T21:22:54Z (14 years ago)

Author:

Lenka Trochtova <trochtova.lenka@…>

Branches:

lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export

Children:

5ebdf94

Parents:

fcbd1be (diff), 9c70ed6 (diff)
Note: this is a merge changeset, the changes displayed below correspond to the merge itself.
Use the (diff) links above to see all the changes relative to each parent.

Message:

merged with head (unstable)

File:

• boot/genarch/ofw.c (modified) (10 diffs)

boot/genarch/ofw.c

@@ -32 +32 @@
 #include <asm.h>
 #include <types.h>
+#include <string.h>
+
+#define RED(i)    (((i) >> 5) & ((1 << 3) - 1))
+#define GREEN(i)  (((i) >> 3) & ((1 << 2) - 1))
+#define BLUE(i)   ((i) & ((1 << 3) - 1))
+#define CLIP(i)   ((i) <= 255 ? (i) : 255)
 
 uintptr_t ofw_cif;
@@ -41 +47 @@
 ihandle ofw_memory_prop;
 phandle ofw_memory;
-phandle ofw_aliases;
 
 void ofw_init(void)
@@ -69 +74 @@
                 halt();
         }
-
+        
         ofw_memory = ofw_find_device("/memory");
         if (ofw_memory == -1) {
@@ -75 +80 @@
                 halt();
         }
-        
-        ofw_aliases = ofw_find_device("/aliases");
-        if (ofw_aliases == -1) {
-                puts("\r\nError: Unable to find /aliases device, halted.\r\n");
-                halt();
-        }
 }
 
 /** Perform a call to OpenFirmware client interface.
  *
- * @param service       String identifying the service requested.
- * @param nargs         Number of input arguments.
- * @param nret          Number of output arguments. This includes the return
- *                      value.
- * @param rets          Buffer for output arguments or NULL. The buffer must
- *                      accommodate nret - 1 items.
- *
- * @return              Return value returned by the client interface.
+ * @param service String identifying the service requested.
+ * @param nargs   Number of input arguments.
+ * @param nret    Number of output arguments. This includes the return
+ *                value.
+ * @param rets    Buffer for output arguments or NULL. The buffer must
+ *                accommodate nret - 1 items.
+ *
+ * @return Return value returned by the client interface.
+ *
  */
 unsigned long
@@ -127 +127 @@
 }
 
-int
-ofw_get_property(const phandle device, const char *name, void *buf,
+int ofw_get_property(const phandle device, const char *name, void *buf,
     const int buflen)
 {
@@ -161 +160 @@
 }
 
-
 unsigned int ofw_get_size_cells(const phandle device)
 {
@@ -221 +219 @@
 }
 
-void *ofw_claim_virt(const void *virt, const int len)
+void *ofw_claim_virt(const void *virt, const unsigned int len)
 {
         ofw_arg_t retaddr;
@@ -234 +232 @@
 }
 
-void *ofw_claim_phys(const void *phys, const int len)
-{
-        ofw_arg_t retaddr[2];
-        int shift;
-
+static void *ofw_claim_phys_internal(const void *phys, const unsigned int len, const unsigned int alignment)
+{
+        /*
+         * Note that the return value check will help
+         * us to discover conflicts between OpenFirmware
+         * allocations and our use of physical memory.
+         * It is better to detect collisions here
+         * than to cope with weird errors later.
+         *
+         * So this is really not to make the loader
+         * more generic; it is here for debugging
+         * purposes.
+         */
+        
         if (sizeof(unative_t) == 8) {
-                shift = 32;
+                ofw_arg_t retaddr[2];
+                int shift = 32;
+                
                 if (ofw_call("call-method", 6, 3, retaddr, "claim",
-                    ofw_memory_prop, 0, len, ((uintptr_t) phys) >> shift,
+                    ofw_memory_prop, alignment, len, ((uintptr_t) phys) >> shift,
                     ((uintptr_t) phys) & ((uint32_t) -1)) != 0) {
-                        /*
-                         * Note that this will help us to discover
-                         * conflicts between OpenFirmware allocations
-                         * and our use of physical memory.
-                         * It is better to detect collisions here
-                         * than to cope with weird errors later.
-                         *
-                         * So this is really not to make the loader
-                         * more generic; it is here for debugging
-                         * purposes.
-                         */
                         puts("Error: memory method claim() failed, halting.\n");
                         halt();
                 }
+                
+                return (void *) ((retaddr[0] << shift) | retaddr[1]);
         } else {
-                shift = 0;
-                /*
-                 * FIXME: the number of arguments is probably different...
-                 */
-                puts("Error: 32-bit ofw_claim_phys not implemented.\n");
-                halt();
-        }
-
-        return (void *) ((retaddr[0] << shift) | retaddr[1]);
-}
-
-int ofw_map(const void *phys, const void *virt, const int size, const int mode)
+                ofw_arg_t retaddr[1];
+                
+                if (ofw_call("call-method", 5, 2, retaddr, "claim",
+                    ofw_memory_prop, alignment, len, (uintptr_t) phys) != 0) {
+                        puts("Error: memory method claim() failed, halting.\n");
+                        halt();
+                }
+                
+                return (void *) retaddr[0];
+        }
+}
+
+void *ofw_claim_phys(const void *phys, const unsigned int len)
+{
+        return ofw_claim_phys_internal(phys, len, 0);
+}
+
+void *ofw_claim_phys_any(const unsigned int len, const unsigned int alignment)
+{
+        return ofw_claim_phys_internal(NULL, len, alignment);
+}
+
+int ofw_map(const void *phys, const void *virt, const unsigned int size, const int mode)
 {
         uintptr_t phys_hi, phys_lo;
@@ -314 +325 @@
 
                 /*
-                 * This is a hot fix of the issue which occurs on machines
-                 * where there are holes in the physical memory (such as
-                 * SunBlade 1500). Should we detect a hole in the physical
-                 * memory, we will ignore any memory detected behind
-                 * the hole and pretend the hole does not exist.
+                 * This is a hot fix of the issue which occurs on machines
+                 * where there are holes in the physical memory (such as
+                 * SunBlade 1500). Should we detect a hole in the physical
+                 * memory, we will ignore any memory detected behind
+                 * the hole and pretend the hole does not exist.
                  */
                 if ((map->count > 0) && (map->zones[map->count - 1].start +
@@ -335 +346 @@
 }
 
-int ofw_screen(screen_t *screen)
-{
-        char device_name[BUF_SIZE];
-        uint32_t virtaddr;
-        
-        if (ofw_get_property(ofw_aliases, "screen", device_name,
-            sizeof(device_name)) <= 0)
-                return false;
-        
-        phandle device = ofw_find_device(device_name);
-        if (device == -1)
-                return false;
-        
-        if (ofw_get_property(device, "address", &virtaddr,
-            sizeof(virtaddr)) <= 0)
-                return false;
-
-        screen->addr = (void *) ((uintptr_t) virtaddr);
-
-        if (ofw_get_property(device, "width", &screen->width,
-            sizeof(screen->width)) <= 0)
-                return false;
-        
-        if (ofw_get_property(device, "height", &screen->height,
-            sizeof(screen->height)) <= 0)
-                return false;
-        
-        if (ofw_get_property(device, "depth", &screen->bpp,
-            sizeof(screen->bpp)) <= 0)
-                return false;
-        
-        if (ofw_get_property(device, "linebytes", &screen->scanline,
-            sizeof(screen->scanline)) <= 0)
-                return false;
-        
-        return true;
-}
-
-#define RED(i)    (((i) >> 5) & ((1 << 3) - 1))
-#define GREEN(i)  (((i) >> 3) & ((1 << 2) - 1))
-#define BLUE(i)   ((i) & ((1 << 3) - 1))
-#define CLIP(i)   ((i) <= 255 ? (i) : 255)
-
-
-/**
- * Sets up the palette for the 8-bit color depth configuration so that the
- * 3:2:3 color scheme can be used. Checks that setting the palette makes sense
- * (appropriate nodes exist in the OBP tree and the color depth is not greater
+static void ofw_setup_screen(phandle handle)
+{
+        /* Check for device type */
+        char device_type[OFW_TREE_PROPERTY_MAX_VALUELEN];
+        if (ofw_get_property(handle, "device_type", device_type, OFW_TREE_PROPERTY_MAX_VALUELEN) <= 0)
+                return;
+        
+        device_type[OFW_TREE_PROPERTY_MAX_VALUELEN - 1] = '\0';
+        if (strcmp(device_type, "display") != 0)
+                return;
+        
+        /* Check for 8 bit depth */
+        uint32_t depth;
+        if (ofw_get_property(handle, "depth", &depth, sizeof(uint32_t)) <= 0)
+                depth = 0;
+        
+        /* Get device path */
+        static char path[OFW_TREE_PATH_MAX_LEN + 1];
+        size_t len = ofw_package_to_path(handle, path, OFW_TREE_PATH_MAX_LEN);
+        if (len == -1)
+                return;
+        
+        path[len] = '\0';
+        
+        /* Open the display to initialize it */
+        ihandle screen = ofw_open(path);
+        if (screen == -1)
+                return;
+        
+        if (depth == 8) {
+                /* Setup the palette so that the (inverted) 3:2:3 scheme is usable */
+                unsigned int i;
+                for (i = 0; i < 256; i++) {
+                        ofw_call("call-method", 6, 1, NULL, "color!", screen,
+                            255 - i, CLIP(BLUE(i) * 37), GREEN(i) * 85, CLIP(RED(i) * 37));
+                }
+        }
+}
+
+static void ofw_setup_screens_internal(phandle current)
+{
+        while ((current != 0) && (current != -1)) {
+                ofw_setup_screen(current);
+                
+                /*
+                 * Recursively process the potential child node.
+                 */
+                phandle child = ofw_get_child_node(current);
+                if ((child != 0) && (child != -1))
+                        ofw_setup_screens_internal(child);
+                
+                /*
+                 * Iteratively process the next peer node.
+                 * Note that recursion is a bad idea here.
+                 * Due to the topology of the OpenFirmware device tree,
+                 * the nesting of peer nodes could be to wide and the
+                 * risk of overflowing the stack is too real.
+                 */
+                phandle peer = ofw_get_peer_node(current);
+                if ((peer != 0) && (peer != -1)) {
+                        current = peer;
+                        /*
+                         * Process the peer in next iteration.
+                         */
+                        continue;
+                }
+                
+                /*
+                 * No more peers on this level.
+                 */
+                break;
+        }
+}
+
+/** Setup all screens which can be detected.
+ *
+ * Open all screens which can be detected and set up the palette for the 8-bit
+ * color depth configuration so that the 3:2:3 color scheme can be used.
+ * Check that setting the palette makes sense (the color depth is not greater
  * than 8).
  *
- * @return true if the palette has been set, false otherwise
- *
  */
-int ofw_setup_palette(void)
-{
-        char device_name[BUF_SIZE];
-        
-        /* resolve alias */
-        if (ofw_get_property(ofw_aliases, "screen", device_name,
-            sizeof(device_name)) <= 0)
-                return false;
-        
-        /* for depth greater than 8 it makes no sense to set up the palette */
-        uint32_t depth;
-        phandle device = ofw_find_device(device_name);
-        if (device == -1)
-                return false;
-        if (ofw_get_property(device, "depth", &depth, sizeof(uint32_t)) <= 0)
-                return false;
-        if (depth != 8)
-                return false;
-        
-        /* required in order to be able to make a method call */
-        ihandle screen = ofw_open(device_name);
-        if (screen == -1)
-                return false;
-        
-        /* setup the palette so that the (inverted) 3:2:3 scheme is usable */
-        unsigned int i;
-        for (i = 0; i < 256; i++)
-                ofw_call("call-method", 6, 1, NULL, "color!", screen,
-                    255 - i, CLIP(BLUE(i) * 37), GREEN(i) * 85, CLIP(RED(i) * 37));
-        return true;
+void ofw_setup_screens(void)
+{
+        ofw_setup_screens_internal(ofw_root);
 }