1/* $NetBSD: yamon.c,v 1.13 2011/02/20 07:48:34 matt Exp $ */ 2 3/* 4 * Copyright 2002 Wasabi Systems, Inc. 5 * All rights reserved. 6 * 7 * Written by Simon Burge for Wasabi Systems, Inc. 8 * 9 * Redistribution and use in source and binary forms, with or without 10 * modification, are permitted provided that the following conditions 11 * are met: 12 * 1. Redistributions of source code must retain the above copyright 13 * notice, this list of conditions and the following disclaimer. 14 * 2. Redistributions in binary form must reproduce the above copyright 15 * notice, this list of conditions and the following disclaimer in the 16 * documentation and/or other materials provided with the distribution. 17 * 3. All advertising materials mentioning features or use of this software 18 * must display the following acknowledgement: 19 * This product includes software developed for the NetBSD Project by 20 * Wasabi Systems, Inc. 21 * 4. The name of Wasabi Systems, Inc. may not be used to endorse 22 * or promote products derived from this software without specific prior 23 * written permission. 24 * 25 * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND 26 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 27 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 28 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL WASABI SYSTEMS, INC 29 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 30 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 31 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 32 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 33 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 34 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 35 * POSSIBILITY OF SUCH DAMAGE. 36 */ 37 38/* XXX move to arch/mips/yamon/yamon.c or similar? */ 39 40#include <sys/cdefs.h> 41__KERNEL_RCSID(0, "$NetBSD: yamon.c,v 1.13 2011/02/20 07:48:34 matt Exp $"); 42 43#include <sys/param.h> 44#include <sys/device.h> 45#include <sys/kernel.h> 46#include <sys/systm.h> 47#include <sys/cpu.h> 48 49#include <dev/cons.h> 50 51#include <mips/locore.h> 52 53#include <machine/yamon.h> 54 55static int yamongetc(dev_t); 56static void yamonputc(dev_t, int); 57 58/* 59 * Default consdev, for errors or warnings before 60 * consinit runs: use the PROM. 61 */ 62struct consdev yamon_promcd = { 63 NULL, /* probe */ 64 NULL, /* init */ 65 yamongetc, /* getc */ 66 yamonputc, /* putc */ 67 nullcnpollc, /* pollc */ 68 NULL, /* bell */ 69 makedev(0, 0), 70 CN_DEAD, 71}; 72/* 73 * Get character from PROM console. 74 */ 75static int 76yamongetc(dev_t dev) 77{ 78 char chr; 79 80 while (!YAMON_GETCHAR(&chr)) 81 /* nothing */; 82 return chr; 83} 84 85/* 86 * Print a character on PROM console. 87 */ 88static void 89yamonputc(dev_t dev, int c) 90{ 91 char chr; 92 93 chr = c; 94 YAMON_PRINT_COUNT(&chr, 1); 95} 96 97char * 98yamon_getenv(const char *name) 99{ 100 yamon_env_var *yev = yamon_envp; 101 102 if (yev == NULL) 103 return (NULL); 104 while (yev->name != NULL) { 105 if (strcmp(yev->name, name) == 0) 106 return (yev->val); 107 yev++; 108 } 109 110 return (NULL); 111} 112 113void 114yamon_print(const char *str) 115{ 116 117 YAMON_PRINT(str); 118} 119 120void 121yamon_exit(uint32_t rc) 122{ 123 124 YAMON_EXIT(rc); 125} 126 127/* 128 * Ask YAMON for the CPU frequency. 129 * If "force" is set, then use a random frequency (100MHz) so 130 * that at least delay() works, even though not perfectly. 131 * Return 1 if YAMON returns a CPU frequency. 132 */ 133int 134yamon_setcpufreq(int force) 135{ 136 struct cpu_info * const ci = curcpu(); 137 uint32_t freq; 138 int ret; 139 140 ret = YAMON_SYSCON_READ(SYSCON_BOARD_CPU_CLOCK_FREQ_ID, &freq, 141 sizeof(freq)); 142 if (!force && (ret != 0 || freq == 0)) 143 return 0; 144 145 if (ret != 0 || freq == 0) { 146 freq = 100 * 1000 * 1000; 147 ret = 0; 148 } else 149 ret = 1; 150 151 ci->ci_cpu_freq = freq; 152 ci->ci_cycles_per_hz = (freq + hz / 2) / hz; 153 ci->ci_divisor_delay = ((freq + 500000) / 1000000); 154 ci->ci_cctr_freq /= ci->ci_cpu_freq; 155 if (mips_options.mips_cpu_flags & CPU_MIPS_DOUBLE_COUNT) { 156 ci->ci_cycles_per_hz /= 2; 157 ci->ci_divisor_delay /= 2; 158 ci->ci_cctr_freq /= 2; 159 } 160 161 return ret; 162} 163