1 /* 2 * Copyright (C) 2004 Florian Schirmer <jolt@tuxbox.org> 3 * 4 * This program is free software; you can redistribute it and/or modify it 5 * under the terms of the GNU General Public License as published by the 6 * Free Software Foundation; either version 2 of the License, or (at your 7 * option) any later version. 8 * 9 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED 10 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF 11 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN 12 * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 13 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 14 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF 15 * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON 16 * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 17 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 18 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 19 * 20 * You should have received a copy of the GNU General Public License along 21 * with this program; if not, write to the Free Software Foundation, Inc., 22 * 675 Mass Ave, Cambridge, MA 02139, USA. 23 */ 24 25 26 #include <linux/init.h> 27 #include <linux/ssb/ssb.h> 28 #include <asm/time.h> 29 #include <bcm47xx.h> 30 #include <bcm47xx_board.h> 31 32 void __init plat_time_init(void) 33 { 34 unsigned long hz = 0; 35 u16 chip_id = 0; 36 char buf[10]; 37 int len; 38 enum bcm47xx_board board = bcm47xx_board_get(); 39 40 /* 41 * Use deterministic values for initial counter interrupt 42 * so that calibrate delay avoids encountering a counter wrap. 43 */ 44 write_c0_count(0); 45 write_c0_compare(0xffff); 46 47 switch (bcm47xx_bus_type) { 48 #ifdef CONFIG_BCM47XX_SSB 49 case BCM47XX_BUS_TYPE_SSB: 50 hz = ssb_cpu_clock(&bcm47xx_bus.ssb.mipscore) / 2; 51 chip_id = bcm47xx_bus.ssb.chip_id; 52 break; 53 #endif 54 #ifdef CONFIG_BCM47XX_BCMA 55 case BCM47XX_BUS_TYPE_BCMA: 56 hz = bcma_cpu_clock(&bcm47xx_bus.bcma.bus.drv_mips) / 2; 57 chip_id = bcm47xx_bus.bcma.bus.chipinfo.id; 58 break; 59 #endif 60 } 61 62 if (chip_id == 0x5354) { 63 len = bcm47xx_nvram_getenv("clkfreq", buf, sizeof(buf)); 64 if (len >= 0 && !strncmp(buf, "200", 4)) 65 hz = 100000000; 66 } 67 68 switch (board) { 69 case BCM47XX_BOARD_ASUS_WL520GC: 70 case BCM47XX_BOARD_ASUS_WL520GU: 71 hz = 100000000; 72 break; 73 default: 74 break; 75 } 76 77 if (!hz) 78 hz = 100000000; 79 80 /* Set MIPS counter frequency for fixed_rate_gettimeoffset() */ 81 mips_hpt_frequency = hz; 82 } 83