11c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno/* 21c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * Copyright (C) 2004 Florian Schirmer <jolt@tuxbox.org> 31c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * 41c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * This program is free software; you can redistribute it and/or modify it 51c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * under the terms of the GNU General Public License as published by the 61c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * Free Software Foundation; either version 2 of the License, or (at your 71c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * option) any later version. 81c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * 91c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED 101c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF 111c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN 121c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 131c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 141c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF 151c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON 161c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 171c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 181c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 191c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * 201c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * You should have received a copy of the GNU General Public License along 211c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * with this program; if not, write to the Free Software Foundation, Inc., 221c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * 675 Mass Ave, Cambridge, MA 02139, USA. 231c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno */ 241c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno 251c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno 261c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno#include <linux/init.h> 271c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno#include <linux/ssb/ssb.h> 281c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno#include <asm/time.h> 291c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno#include <bcm47xx.h> 302224de9d152b6fd9faa0df49cf55ca97eab772faHauke Mehrtens#include <bcm47xx_nvram.h> 318eae19ccaeb5f519fc413c9646398a77dfbfa201Hauke Mehrtens#include <bcm47xx_board.h> 321c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno 334b550488f894c899aa54dc935c8fee47bca2b7dfRalf Baechlevoid __init plat_time_init(void) 341c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno{ 3508ccf57283f89adbc2ff897ad82d6ad4560db7cdHauke Mehrtens unsigned long hz = 0; 362224de9d152b6fd9faa0df49cf55ca97eab772faHauke Mehrtens u16 chip_id = 0; 372224de9d152b6fd9faa0df49cf55ca97eab772faHauke Mehrtens char buf[10]; 382224de9d152b6fd9faa0df49cf55ca97eab772faHauke Mehrtens int len; 398eae19ccaeb5f519fc413c9646398a77dfbfa201Hauke Mehrtens enum bcm47xx_board board = bcm47xx_board_get(); 401c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno 411c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno /* 421c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * Use deterministic values for initial counter interrupt 431c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno * so that calibrate delay avoids encountering a counter wrap. 441c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno */ 451c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno write_c0_count(0); 461c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno write_c0_compare(0xffff); 471c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno 4808ccf57283f89adbc2ff897ad82d6ad4560db7cdHauke Mehrtens switch (bcm47xx_bus_type) { 49a656ffcbc7a98a80d2136ae6bbdd8ae2eb48c78aHauke Mehrtens#ifdef CONFIG_BCM47XX_SSB 5008ccf57283f89adbc2ff897ad82d6ad4560db7cdHauke Mehrtens case BCM47XX_BUS_TYPE_SSB: 5108ccf57283f89adbc2ff897ad82d6ad4560db7cdHauke Mehrtens hz = ssb_cpu_clock(&bcm47xx_bus.ssb.mipscore) / 2; 522224de9d152b6fd9faa0df49cf55ca97eab772faHauke Mehrtens chip_id = bcm47xx_bus.ssb.chip_id; 5308ccf57283f89adbc2ff897ad82d6ad4560db7cdHauke Mehrtens break; 54a656ffcbc7a98a80d2136ae6bbdd8ae2eb48c78aHauke Mehrtens#endif 55c1d1c5d4213ee96e054c4d195117368972a4c01fHauke Mehrtens#ifdef CONFIG_BCM47XX_BCMA 56c1d1c5d4213ee96e054c4d195117368972a4c01fHauke Mehrtens case BCM47XX_BUS_TYPE_BCMA: 57c1d1c5d4213ee96e054c4d195117368972a4c01fHauke Mehrtens hz = bcma_cpu_clock(&bcm47xx_bus.bcma.bus.drv_mips) / 2; 582224de9d152b6fd9faa0df49cf55ca97eab772faHauke Mehrtens chip_id = bcm47xx_bus.bcma.bus.chipinfo.id; 59c1d1c5d4213ee96e054c4d195117368972a4c01fHauke Mehrtens break; 60c1d1c5d4213ee96e054c4d195117368972a4c01fHauke Mehrtens#endif 6108ccf57283f89adbc2ff897ad82d6ad4560db7cdHauke Mehrtens } 6208ccf57283f89adbc2ff897ad82d6ad4560db7cdHauke Mehrtens 632224de9d152b6fd9faa0df49cf55ca97eab772faHauke Mehrtens if (chip_id == 0x5354) { 642224de9d152b6fd9faa0df49cf55ca97eab772faHauke Mehrtens len = bcm47xx_nvram_getenv("clkfreq", buf, sizeof(buf)); 652224de9d152b6fd9faa0df49cf55ca97eab772faHauke Mehrtens if (len >= 0 && !strncmp(buf, "200", 4)) 662224de9d152b6fd9faa0df49cf55ca97eab772faHauke Mehrtens hz = 100000000; 672224de9d152b6fd9faa0df49cf55ca97eab772faHauke Mehrtens } 682224de9d152b6fd9faa0df49cf55ca97eab772faHauke Mehrtens 698eae19ccaeb5f519fc413c9646398a77dfbfa201Hauke Mehrtens switch (board) { 708eae19ccaeb5f519fc413c9646398a77dfbfa201Hauke Mehrtens case BCM47XX_BOARD_ASUS_WL520GC: 718eae19ccaeb5f519fc413c9646398a77dfbfa201Hauke Mehrtens case BCM47XX_BOARD_ASUS_WL520GU: 728eae19ccaeb5f519fc413c9646398a77dfbfa201Hauke Mehrtens hz = 100000000; 738eae19ccaeb5f519fc413c9646398a77dfbfa201Hauke Mehrtens break; 748eae19ccaeb5f519fc413c9646398a77dfbfa201Hauke Mehrtens default: 758eae19ccaeb5f519fc413c9646398a77dfbfa201Hauke Mehrtens break; 768eae19ccaeb5f519fc413c9646398a77dfbfa201Hauke Mehrtens } 778eae19ccaeb5f519fc413c9646398a77dfbfa201Hauke Mehrtens 781c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno if (!hz) 791c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno hz = 100000000; 801c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno 811c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno /* Set MIPS counter frequency for fixed_rate_gettimeoffset() */ 821c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno mips_hpt_frequency = hz; 831c0c13eb935c95fd2ca0b0aca6dd4860487fb242Aurelien Jarno} 84