bcma: add functions to scan cores needed on SoCs

[cascardo/linux.git] / drivers / bcma / driver_chipcommon.c

diff --git a/drivers/bcma/driver_chipcommon.c b/drivers/bcma/driver_chipcommon.c
index 6061022..acca327 100644 (file)
--- a/drivers/bcma/driver_chipcommon.c
+++ b/drivers/bcma/driver_chipcommon.c
@@ -3,7 +3,7 @@
  * ChipCommon core driver
  *
  * Copyright 2005, Broadcom Corporation
- * Copyright 2006, 2007, Michael Buesch <mb@bu3sch.de>
+ * Copyright 2006, 2007, Michael Buesch <m@bues.ch>
  *
  * Licensed under the GNU/GPL. See COPYING for details.
  */
@@ -23,6 +23,12 @@ static inline u32 bcma_cc_write32_masked(struct bcma_drv_cc *cc, u16 offset,
 
 void bcma_core_chipcommon_init(struct bcma_drv_cc *cc)
 {
+       u32 leddc_on = 10;
+       u32 leddc_off = 90;
+
+       if (cc->setup_done)
+               return;
+
        if (cc->core->id.rev >= 11)
                cc->status = bcma_cc_read32(cc, BCMA_CC_CHIPSTAT);
        cc->capabilities = bcma_cc_read32(cc, BCMA_CC_CAP);
@@ -38,6 +44,19 @@ void bcma_core_chipcommon_init(struct bcma_drv_cc *cc)
                bcma_pmu_init(cc);
        if (cc->capabilities & BCMA_CC_CAP_PCTL)
                pr_err("Power control not implemented!\n");
+
+       if (cc->core->id.rev >= 16) {
+               if (cc->core->bus->sprom.leddc_on_time &&
+                   cc->core->bus->sprom.leddc_off_time) {
+                       leddc_on = cc->core->bus->sprom.leddc_on_time;
+                       leddc_off = cc->core->bus->sprom.leddc_off_time;
+               }
+               bcma_cc_write32(cc, BCMA_CC_GPIOTIMER,
+                       ((leddc_on << BCMA_CC_GPIOTIMER_ONTIME_SHIFT) |
+                        (leddc_off << BCMA_CC_GPIOTIMER_OFFTIME_SHIFT)));
+       }
+
+       cc->setup_done = true;
 }
 
 /* Set chip watchdog reset timer to fire in 'ticks' backplane cycles */