diff --git a/target/linux/ar7/files/arch/mips/ar7/platform.c b/target/linux/ar7/files/arch/mips/ar7/platform.c index c2629861e1..c1cd5f97b9 100644 --- a/target/linux/ar7/files/arch/mips/ar7/platform.c +++ b/target/linux/ar7/files/arch/mips/ar7/platform.c @@ -31,6 +31,7 @@ #include #include #include +#include #include #include @@ -322,7 +323,7 @@ static struct gpio_led default_leds[] = { { .name = "status", .gpio = 8, .active_low = 1, }, }; -static struct gpio_led fb_leds[] = { +static struct gpio_led fb_sl_leds[] = { { .name = "1", .gpio = 7, }, { .name = "2", .gpio = 13, .active_low = 1, }, { .name = "3", .gpio = 10, .active_low = 1, }, @@ -389,6 +390,30 @@ static void cpmac_get_mac(int instance, unsigned char *dev_addr) char2hex(mac[i * 3 + 1]); } +static void __init detect_leds(void) +{ + char *prId; + + /* Default LEDs */ + ar7_led_data.num_leds = ARRAY_SIZE(default_leds); + ar7_led_data.leds = default_leds; + + /* FIXME: the whole thing is unreliable */ + prId = prom_getenv("ProductID"); + + /* If we can't get the product id from PROM, use the default LEDs */ + if (!prId) + return; + + if (strstr(prId, "Fritz_Box_FON")) { + ar7_led_data.num_leds = ARRAY_SIZE(fb_fon_leds); + ar7_led_data.leds = fb_fon_leds; + } else if (strstr(prId, "Fritz_Box_")) { + ar7_led_data.num_leds = ARRAY_SIZE(fb_sl_leds); + ar7_led_data.leds = fb_sl_leds; + } +} + static int __init ar7_register_devices(void) { int res; @@ -472,9 +497,7 @@ static int __init ar7_register_devices(void) if (res) return res; -#warning FIXME: add model detection - ar7_led_data.num_leds = ARRAY_SIZE(default_leds); - ar7_led_data.leds = default_leds; + detect_leds(); res = platform_device_register(&ar7_gpio_leds); if (res) return res;