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 208af8c8fda4214edf83160f399a2348aecab362..9e62114b1a0f496972a4e98080ecad1141646eba 100644 (file)
--- a/target/linux/ar71xx/files/arch/mips/ar71xx/platform.c
+++ b/target/linux/ar71xx/files/arch/mips/ar71xx/platform.c
@@ -43,7 +43,7 @@ static struct resource ar71xx_usb_ohci_resources[] = {
 static u64 ar71xx_ohci_dmamask = DMA_BIT_MASK(32);
 static struct platform_device ar71xx_usb_ohci_device = {
        .name           = "ar71xx-ohci",
-       .id             = 0,
+       .id             = -1,
        .resource       = ar71xx_usb_ohci_resources,
        .num_resources  = ARRAY_SIZE(ar71xx_usb_ohci_resources),
        .dev = {
@@ -71,7 +71,7 @@ static struct resource ar71xx_usb_ehci_resources[] = {
 static u64 ar71xx_ehci_dmamask = DMA_BIT_MASK(32);
 static struct platform_device ar71xx_usb_ehci_device = {
        .name           = "ar71xx-ehci",
-       .id             = 0,
+       .id             = -1,
        .resource       = ar71xx_usb_ehci_resources,
        .num_resources  = ARRAY_SIZE(ar71xx_usb_ehci_resources),
        .dev = {
@@ -334,7 +334,92 @@ void __init ar71xx_add_device_spi(struct ar71xx_spi_platform_data *pdata,
        platform_device_register(&ar71xx_spi_device);
 }
 
-void __init ar71xx_set_mac_base(char *mac_str)
+void __init ar71xx_add_device_leds_gpio(int id, unsigned num_leds,
+                               struct gpio_led *leds)
+{
+       struct platform_device *pdev;
+       struct gpio_led_platform_data pdata;
+       struct gpio_led *p;
+       int err;
+
+       p = kmalloc(num_leds * sizeof(*p), GFP_KERNEL);
+       if (!p)
+               return;
+
+       memcpy(p, leds, num_leds * sizeof(*p));
+
+       pdev = platform_device_alloc("leds-gpio", id);
+       if (!pdev)
+               goto err_free_leds;
+
+       pdata.num_leds = num_leds;
+       pdata.leds = leds;
+
+       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_leds:
+       kfree(p);
+}
+
+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;
@@ -343,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);