[OpenBIOS] r604 - trunk/openbios-devel/drivers

Author: laurent
Date: 2009-11-10 21:50:36 +0000 (Tue, 10 Nov 2009)
New Revision: 604

Modified:
   trunk/openbios-devel/drivers/macio.c
Log:
Define methods to decode/encode mac-io units.

Signed-off-by: Laurent Vivier

Modified: trunk/openbios-devel/drivers/macio.c
===================================================================
--- trunk/openbios-devel/drivers/macio.c	2009-11-10 21:39:42 UTC (rev 603)
+++ trunk/openbios-devel/drivers/macio.c	2009-11-10 21:50:36 UTC (rev 604)
@@ -170,11 +170,49 @@
         set_int_property(dnode, "clock-frequency", 4166666);
 }

+DECLARE_NODE(ob_macio, INSTALL_OPEN, sizeof(int), "Tmac-io");
+
+/* ( str len -- addr ) */
+
+static void
+ob_macio_decode_unit(void *private)
+{
+	ucell addr;
+
+	const char *arg = pop_fstr_copy();
+
+	addr = strtol(arg, NULL, 16);
+
+	free((char*)arg);
+
+	PUSH(addr);
+}
+
+/*  ( addr -- str len ) */
+
+static void
+ob_macio_encode_unit(void *private)
+{
+	char buf[8];
+
+	ucell addr = POP();
+
+	snprintf(buf, sizeof(buf), "%x", addr);
+
+	push_str(buf);
+}
+
+NODE_METHODS(ob_macio) = {
+        { "decode-unit",	ob_macio_decode_unit	},
+        { "encode-unit",	ob_macio_encode_unit	},
+};
+
 void
 ob_macio_heathrow_init(const char *path, uint32_t addr)
 {
         phandle_t aliases;

+	REGISTER_NODE(ob_macio);
    aliases = find_dev("/aliases");
    set_property(aliases, "mac-io", path, strlen(path) + 1);