2012-11-24 20:28:06 +00:00
|
|
|
--- a/arch/mips/bcm47xx/time.c
|
|
|
|
+++ b/arch/mips/bcm47xx/time.c
|
|
|
|
@@ -27,10 +27,14 @@
|
|
|
|
#include <linux/ssb/ssb.h>
|
|
|
|
#include <asm/time.h>
|
|
|
|
#include <bcm47xx.h>
|
2013-01-03 01:53:30 +00:00
|
|
|
+#include <bcm47xx_nvram.h>
|
2012-11-24 20:28:06 +00:00
|
|
|
|
|
|
|
void __init plat_time_init(void)
|
|
|
|
{
|
|
|
|
unsigned long hz = 0;
|
|
|
|
+ u16 chip_id = 0;
|
|
|
|
+ char buf[10];
|
|
|
|
+ int len;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Use deterministic values for initial counter interrupt
|
|
|
|
@@ -43,15 +47,26 @@ void __init plat_time_init(void)
|
|
|
|
#ifdef CONFIG_BCM47XX_SSB
|
|
|
|
case BCM47XX_BUS_TYPE_SSB:
|
|
|
|
hz = ssb_cpu_clock(&bcm47xx_bus.ssb.mipscore) / 2;
|
|
|
|
+ chip_id = bcm47xx_bus.ssb.chip_id;
|
|
|
|
break;
|
|
|
|
#endif
|
|
|
|
#ifdef CONFIG_BCM47XX_BCMA
|
|
|
|
case BCM47XX_BUS_TYPE_BCMA:
|
|
|
|
hz = bcma_cpu_clock(&bcm47xx_bus.bcma.bus.drv_mips) / 2;
|
|
|
|
+ chip_id = bcm47xx_bus.bcma.bus.chipinfo.id;
|
|
|
|
break;
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
+ if (chip_id == 0x5354) {
|
2013-01-03 01:53:30 +00:00
|
|
|
+ len = bcm47xx_nvram_getenv("clkfreq", buf, sizeof(buf));
|
2012-11-24 20:28:06 +00:00
|
|
|
+ if (len >= 0 && !strncmp(buf, "200", 4))
|
|
|
|
+ hz = 100000000;
|
2013-01-03 01:53:30 +00:00
|
|
|
+ len = bcm47xx_nvram_getenv("hardware_version", buf, sizeof(buf));
|
2012-11-24 20:28:06 +00:00
|
|
|
+ if (len >= 0 && !strncmp(buf, "WL520G", 6))
|
|
|
|
+ hz = 100000000;
|
|
|
|
+
|
|
|
|
+ }
|
|
|
|
if (!hz)
|
|
|
|
hz = 100000000;
|
|
|
|
|