add MyLoader support

[librecmc/librecmc.git] / target / linux / ar71xx / files / arch / mips / ar71xx / platform.c

diff --git a/target/linux/ar71xx/files/arch/mips/ar71xx/platform.c b/target/linux/ar71xx/files/arch/mips/ar71xx/platform.c
index 3bda20e52da0788e38a5a0732bd55f15e1f193a1..9e62114b1a0f496972a4e98080ecad1141646eba 100644 (file)
--- a/target/linux/ar71xx/files/arch/mips/ar71xx/platform.c
+++ b/target/linux/ar71xx/files/arch/mips/ar71xx/platform.c
@@ -372,7 +372,54 @@ err_free_leds:
        kfree(p);
 }
 
-void __init ar71xx_set_mac_base(char *mac_str)
+void __init ar71xx_add_device_gpio_buttons(int id,
+                                          unsigned poll_interval,
+                                          unsigned nbuttons,
+                                          struct gpio_button *buttons)
+{
+       struct platform_device *pdev;
+       struct gpio_buttons_platform_data pdata;
+       struct gpio_button *p;
+       int err;
+
+       p = kmalloc(nbuttons * sizeof(*p), GFP_KERNEL);
+       if (!p)
+               return;
+
+       memcpy(p, buttons, nbuttons * sizeof(*p));
+
+       pdev = platform_device_alloc("gpio-buttons", id);
+       if (!pdev)
+               goto err_free_buttons;
+
+       pdata.poll_interval = poll_interval;
+       pdata.nbuttons = nbuttons;
+       pdata.buttons = p;
+
+       err = platform_device_add_data(pdev, &pdata, sizeof(pdata));
+       if (err)
+               goto err_put_pdev;
+
+
+       err = platform_device_add(pdev);
+       if (err)
+               goto err_put_pdev;
+
+       return;
+
+err_put_pdev:
+       platform_device_put(pdev);
+
+err_free_buttons:
+       kfree(p);
+}
+
+void __init ar71xx_set_mac_base(unsigned char *mac)
+{
+       memcpy(ar71xx_mac_base, mac, ETH_ALEN);
+}
+
+void __init ar71xx_parse_mac_addr(char *mac_str)
 {
        u8 tmp[ETH_ALEN];
        int t;
@@ -381,7 +428,7 @@ void __init ar71xx_set_mac_base(char *mac_str)
                        &tmp[0], &tmp[1], &tmp[2], &tmp[3], &tmp[4], &tmp[5]);
 
        if (t == ETH_ALEN)
-               memcpy(ar71xx_mac_base, tmp, ETH_ALEN);
+               ar71xx_set_mac_base(tmp);
        else
                printk(KERN_DEBUG "AR71XX: failed to parse mac address "
                                "\"%s\"\n", mac_str);