rtc.c revision 1.1
1 /* $NetBSD: rtc.c,v 1.1 1999/09/16 12:23:32 takemura Exp $ */ 2 3 /*- 4 * Copyright (c) 1999 Shin Takemura. All rights reserved. 5 * Copyright (c) 1999 SATO Kazumi. All rights reserved. 6 * Copyright (c) 1999 PocketBSD Project. All rights reserved. 7 * 8 * Redistribution and use in source and binary forms, with or without 9 * modification, are permitted provided that the following conditions 10 * are met: 11 * 1. Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 3. All advertising materials mentioning features or use of this software 17 * must display the following acknowledgement: 18 * This product includes software developed by the PocketBSD project 19 * and its contributors. 20 * 4. Neither the name of the project nor the names of its contributors 21 * may be used to endorse or promote products derived from this software 22 * without specific prior written permission. 23 * 24 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 25 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 27 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 28 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 29 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 30 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 31 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 32 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 33 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 34 * SUCH DAMAGE. 35 * 36 */ 37 38 #include <sys/param.h> 39 #include <sys/systm.h> 40 #include <sys/device.h> 41 #include <sys/reboot.h> 42 43 #include <machine/bus.h> 44 #include <machine/clock_machdep.h> 45 #include <machine/cpu.h> 46 47 #include <hpcmips/vr/vr.h> 48 #include <hpcmips/vr/vripvar.h> 49 #include <hpcmips/vr/rtcreg.h> 50 #include <dev/dec/clockvar.h> 51 52 #if 0 53 #define RTCDEBUG /* rtc debugging infomation */ 54 #define RTC_HEARTBEAT /* HEARTBEAT print */ 55 #define RECALC_CPUSPEED /* cpuspeed recalculaton */ 56 #define RECALC_CPUSPEED_DEBUG /* XXX */ 57 #endif 58 59 60 struct vrrtc_softc { 61 struct device sc_dev; 62 bus_space_tag_t sc_iot; 63 bus_space_handle_t sc_ioh; 64 void *sc_ih; 65 }; 66 67 void clock_init __P((struct device *)); 68 void clock_get __P((struct device *, time_t, struct clocktime *)); 69 void clock_set __P((struct device *, struct clocktime *)); 70 71 static const struct clockfns clockfns = { 72 clock_init, clock_get, clock_set, 73 }; 74 75 int vrrtc_match __P((struct device *, struct cfdata *, void *)); 76 void vrrtc_attach __P((struct device *, struct device *, void *)); 77 int vrrtc_intr __P((void*, u_int32_t, u_int32_t)); 78 79 struct cfattach vrrtc_ca = { 80 sizeof(struct vrrtc_softc), vrrtc_match, vrrtc_attach 81 }; 82 83 void vrrtc_write __P((struct vrrtc_softc *, int, unsigned short)); 84 unsigned short vrrtc_read __P((struct vrrtc_softc *, int)); 85 void cvt_timehl_ct __P((u_long, u_long, struct clocktime *)); 86 int vrrtc_recalc_cpuspeed __P((struct device *)); 87 88 89 extern int rtc_offset; 90 91 int 92 vrrtc_match(parent, cf, aux) 93 struct device *parent; 94 struct cfdata *cf; 95 void *aux; 96 { 97 return(1); 98 } 99 100 inline void 101 vrrtc_write(sc, port, val) 102 struct vrrtc_softc *sc; 103 int port; 104 unsigned short val; 105 { 106 bus_space_write_2(sc->sc_iot, sc->sc_ioh, port, val); 107 } 108 109 inline unsigned short 110 vrrtc_read(sc, port) 111 struct vrrtc_softc *sc; 112 int port; 113 { 114 return bus_space_read_2(sc->sc_iot, sc->sc_ioh, port); 115 } 116 117 void 118 vrrtc_attach(parent, self, aux) 119 struct device *parent; 120 struct device *self; 121 void *aux; 122 { 123 struct vrip_attach_args *va = aux; 124 struct vrrtc_softc *sc = (void*)self; 125 126 sc->sc_iot = va->va_iot; 127 if (bus_space_map(sc->sc_iot, va->va_addr, va->va_size, 128 0 /* no flags */, &sc->sc_ioh)) { 129 printf("vrrtc_attach: can't map i/o space\n"); 130 return; 131 } 132 /* RTC interrupt handler is directly dispatched from CPU intr */ 133 vr_intr_establish(VR_INTR1, vrrtc_intr, sc); 134 /* But need to set level 1 interupt mask register, 135 * so regsiter fake interrurpt handler 136 */ 137 if (!(sc->sc_ih = vrip_intr_establish(va->va_vc, va->va_intr, 138 IPL_CLOCK, 0, 0))) { 139 printf (":can't map interrupt.\n"); 140 return; 141 } 142 /* 143 * Rtc is attached to call this routine 144 * before cpu_initclock() calls clock_init(). 145 * So we must disable all interrupt for now. 146 */ 147 /* 148 * Disable all rtc interrupts 149 */ 150 /* Disable Elapse compare intr */ 151 bus_space_write_2(sc->sc_iot, sc->sc_ioh, ECMP_H_REG_W, 0); 152 bus_space_write_2(sc->sc_iot, sc->sc_ioh, ECMP_M_REG_W, 0); 153 bus_space_write_2(sc->sc_iot, sc->sc_ioh, ECMP_L_REG_W, 0); 154 /* Disable RTC Long1 intr */ 155 bus_space_write_2(sc->sc_iot, sc->sc_ioh, RTCL1_H_REG_W, 0); 156 bus_space_write_2(sc->sc_iot, sc->sc_ioh, RTCL1_L_REG_W, 0); 157 /* Disable RTC Long2 intr */ 158 bus_space_write_2(sc->sc_iot, sc->sc_ioh, RTCL2_H_REG_W, 0); 159 bus_space_write_2(sc->sc_iot, sc->sc_ioh, RTCL2_L_REG_W, 0); 160 /* Disable RTC TCLK intr */ 161 bus_space_write_2(sc->sc_iot, sc->sc_ioh, TCLK_H_REG_W, 0); 162 bus_space_write_2(sc->sc_iot, sc->sc_ioh, TCLK_L_REG_W, 0); 163 /* 164 * Clear all rtc intrrupts. 165 */ 166 bus_space_write_2(sc->sc_iot, sc->sc_ioh, RTCINT_REG_W, RTCINT_ALL); 167 168 clockattach(&sc->sc_dev, &clockfns); 169 } 170 171 int 172 vrrtc_intr(arg, pc, statusReg) 173 void *arg; 174 u_int32_t pc; 175 u_int32_t statusReg; 176 { 177 struct vrrtc_softc *sc = arg; 178 struct clockframe cf; 179 180 bus_space_write_2(sc->sc_iot, sc->sc_ioh, RTCINT_REG_W, RTCINT_ALL); 181 cf.pc = pc; 182 cf.sr = statusReg; 183 hardclock(&cf); 184 intrcnt[HARDCLOCK]++; 185 186 #ifdef RTC_HEARTBEAT 187 if ((intrcnt[HARDCLOCK] % (CLOCK_RATE * 5)) == 0) { 188 struct clocktime ct; 189 clock_get((struct device *)sc, NULL, &ct); 190 printf("%s(%d): rtc_intr: %2d.%2d.%2d %02d:%02d:%02d\n", 191 __FILE__, __LINE__, 192 ct.year, ct.mon, ct.day, 193 ct.hour, ct.min, ct.sec); 194 } 195 #endif 196 return 0; 197 } 198 199 200 int 201 vrrtc_recalc_cpuspeed(dev) 202 struct device *dev; 203 { 204 struct vrrtc_softc *sc = (struct vrrtc_softc *)dev; 205 u_long otimeh; 206 u_long otimel; 207 u_long timeh; 208 u_long timel; 209 210 otimeh = bus_space_read_2(sc->sc_iot, sc->sc_ioh, ETIME_H_REG_W); 211 otimel = bus_space_read_2(sc->sc_iot, sc->sc_ioh, ETIME_M_REG_W); 212 otimel = (otimel << 16) 213 | bus_space_read_2(sc->sc_iot, sc->sc_ioh, ETIME_L_REG_W); 214 215 #define MSEC 1000 216 /* wait 1msec */ 217 DELAY(MSEC); 218 219 timeh = bus_space_read_2(sc->sc_iot, sc->sc_ioh, ETIME_H_REG_W); 220 timel = bus_space_read_2(sc->sc_iot, sc->sc_ioh, ETIME_M_REG_W); 221 timel = (timel << 16) 222 | bus_space_read_2(sc->sc_iot, sc->sc_ioh, ETIME_L_REG_W); 223 224 if (timeh-otimeh > 0){ 225 /* cpuspeed is too large (> 2 sec)*/ 226 cpuspeed = cpuspeed/((timeh-otimeh)*2*MSEC); 227 cpuspeed +=1; 228 return 0; 229 } 230 if (timel-otimel < (ETIME_L_HZ/MSEC/10)) { 231 /* cpuspeed is too small (< 0.1msec) */ 232 cpuspeed *=10; 233 return -1; 234 } 235 cpuspeed = cpuspeed * (ETIME_L_HZ/MSEC) / (timel-otimel); 236 return 0; 237 } 238 239 void 240 clock_init(dev) 241 struct device *dev; 242 { 243 struct vrrtc_softc *sc = (struct vrrtc_softc *)dev; 244 #ifdef RTCDEBUG 245 int timeh; 246 int timel; 247 #endif /* RTCDEBUG */ 248 #ifdef RECALC_CPUSPEED 249 int maxrecalc = 3; 250 #endif /* RECALC_CPUSPEED */ 251 252 #ifdef RTCDEBUG 253 timeh = bus_space_read_2(sc->sc_iot, sc->sc_ioh, ETIME_H_REG_W); 254 timel = bus_space_read_2(sc->sc_iot, sc->sc_ioh, ETIME_M_REG_W); 255 timel = (timel << 16) 256 | bus_space_read_2(sc->sc_iot, sc->sc_ioh, ETIME_L_REG_W); 257 printf("clock_init() Elapse Time %04x%04x\n", timeh, timel); 258 259 timeh = bus_space_read_2(sc->sc_iot, sc->sc_ioh, ECMP_H_REG_W); 260 timel = bus_space_read_2(sc->sc_iot, sc->sc_ioh, ECMP_M_REG_W); 261 timel = (timel << 16) 262 | bus_space_read_2(sc->sc_iot, sc->sc_ioh, ECMP_L_REG_W); 263 printf("clock_init() Elapse Compare %04x%04x\n", timeh, timel); 264 265 timeh = bus_space_read_2(sc->sc_iot, sc->sc_ioh, RTCL1_H_REG_W); 266 timel = bus_space_read_2(sc->sc_iot, sc->sc_ioh, RTCL1_L_REG_W); 267 printf("clock_init() LONG1 %04x%04x\n", timeh, timel); 268 269 timeh = bus_space_read_2(sc->sc_iot, sc->sc_ioh, RTCL1_CNT_H_REG_W); 270 timel = bus_space_read_2(sc->sc_iot, sc->sc_ioh, RTCL1_CNT_L_REG_W); 271 printf("clock_init() LONG1 CNTL %04x%04x\n", timeh, timel); 272 273 timeh = bus_space_read_2(sc->sc_iot, sc->sc_ioh, RTCL2_H_REG_W); 274 timel = bus_space_read_2(sc->sc_iot, sc->sc_ioh, RTCL2_L_REG_W); 275 printf("clock_init() LONG2 %04x%04x\n", timeh, timel); 276 277 timeh = bus_space_read_2(sc->sc_iot, sc->sc_ioh, RTCL2_CNT_H_REG_W); 278 timel = bus_space_read_2(sc->sc_iot, sc->sc_ioh, RTCL2_CNT_L_REG_W); 279 printf("clock_init() LONG2 CNTL %04x%04x\n", timeh, timel); 280 281 timeh = bus_space_read_2(sc->sc_iot, sc->sc_ioh, TCLK_H_REG_W); 282 timel = bus_space_read_2(sc->sc_iot, sc->sc_ioh, TCLK_L_REG_W); 283 printf("clock_init() TCLK %04x%04x\n", timeh, timel); 284 285 timeh = bus_space_read_2(sc->sc_iot, sc->sc_ioh, TCLK_CNT_H_REG_W); 286 timel = bus_space_read_2(sc->sc_iot, sc->sc_ioh, TCLK_CNT_L_REG_W); 287 printf("clock_init() TCLK CNTL %04x%04x\n", timeh, timel); 288 #endif /* RTCDEBUG */ 289 /* 290 * Set tick (CLOCK_RATE) 291 */ 292 bus_space_write_2(sc->sc_iot, sc->sc_ioh, RTCL1_H_REG_W, 0); 293 bus_space_write_2(sc->sc_iot, sc->sc_ioh, 294 RTCL1_L_REG_W, RTCL1_L_HZ/CLOCK_RATE); 295 296 #ifdef RECALC_CPUSPEED 297 /* calcurate cpu speed */ 298 while (maxrecalc-- > 0 && vrrtc_recalc_cpuspeed(dev)) 299 ; 300 #ifdef RECALC_CPUSPEED_DEBUG 301 printf("clock_init() cpuspeed = %d\n", cpuspeed); 302 #endif /* RECALC_CPUSPEED_DEBUG */ 303 #endif /* RECALC_CPUSPEED */ 304 } 305 306 static int m2d[12] = { 31, 28, 31, 30, 31, 30, 31, 31, 30, 31, 30, 31}; 307 308 void 309 cvt_timehl_ct(timeh, timel, ct) 310 u_long timeh; /* 2 sec */ 311 u_long timel; /* 1/32768 sec */ 312 struct clocktime *ct; 313 { 314 #define EPOCHOFF 0 315 #define EPOCHYEAR 1850 /* XXXX */ 316 #define EPOCHMONTH 0 317 #define EPOCHDATE 0 318 319 u_long year, month, date, hour, min, sec, sec2; 320 321 timeh -= EPOCHOFF; 322 323 timeh += (rtc_offset*(SECMIN/2)); 324 325 year = EPOCHYEAR; 326 sec2 = LEAPYEAR4(year)?(SECYR+SECDAY)/2:SECYR/2; 327 while (timeh > sec2) { 328 year++; 329 timeh -= sec2; 330 sec2 = LEAPYEAR4(year)?(SECYR+SECDAY)/2:SECYR/2; 331 } 332 333 #ifdef RTCDEBUG 334 printf("cvt_timehl_ct: timeh %08lx year %ld yrref %ld\n", 335 timeh, year, sec2); 336 #endif /* RTCDEBUG */ 337 338 month = 0; /* now month is 0..11 */ 339 sec2 = (SECDAY * m2d[month])/2; 340 while (timeh > sec2) { 341 timeh -= sec2; 342 month++; 343 sec2 = (SECDAY * m2d[month])/2; 344 if (month == 1 && LEAPYEAR4(year)) /* feb. and leapyear */ 345 sec2 += SECDAY/2; 346 } 347 month +=1; /* now month is 1..12 */ 348 349 #ifdef RTCDEBUG 350 printf("cvt_timehl_ct: timeh %08lx month %ld mref %ld\n", 351 timeh, month, sec2); 352 #endif /* RTCDEBUG */ 353 354 sec2 = SECDAY/2; 355 date = timeh/sec2+1; /* date is 1..31 */ 356 timeh -= (date-1)*sec2; 357 358 #ifdef RTCDEBUG 359 printf("cvt_timehl_ct: timeh %08lx date %ld dref %ld\n", 360 timeh, date, sec2); 361 #endif /* RTCDEBUG */ 362 363 sec2 = SECHOUR/2; 364 hour = timeh/sec2; 365 timeh -= hour*sec2; 366 367 sec2 = SECMIN/2; 368 min = timeh/sec2; 369 timeh -= min*sec2; 370 371 sec = timeh*2 + timel/ETIME_L_HZ; 372 373 #ifdef RTCDEBUG 374 printf("cvt_timehl_ct: hour %ld min %ld sec %ld\n", hour, min, sec); 375 #endif /* RTCDEBUG */ 376 377 if (ct) { 378 ct->year = year - 1900; /* base 1900 */ 379 ct->mon = month; 380 ct->day = date; 381 ct->hour = hour; 382 ct->min = min; 383 ct->sec = sec; 384 } 385 } 386 387 void 388 clock_get(dev, base, ct) 389 struct device *dev; 390 time_t base; 391 struct clocktime *ct; 392 { 393 394 struct vrrtc_softc *sc = (struct vrrtc_softc *)dev; 395 u_long timeh; /* elapse time (2*timeh sec) */ 396 u_long timel; /* timel/32768 sec */ 397 398 timeh = bus_space_read_2(sc->sc_iot, sc->sc_ioh, ETIME_H_REG_W); 399 timeh = (timeh << 16) 400 | bus_space_read_2(sc->sc_iot, sc->sc_ioh, ETIME_M_REG_W); 401 timel = bus_space_read_2(sc->sc_iot, sc->sc_ioh, ETIME_L_REG_W); 402 403 #ifdef RTCDEBUG 404 printf("clock_get: timeh %08lx timel %08lx\n", timeh, timel); 405 #endif /* RTCDEBUG */ 406 407 cvt_timehl_ct(timeh, timel, ct); 408 409 #ifdef RTCDEBUG 410 printf("clock_get: %d/%d/%d/%d/%d/%d\n", 411 ct->year, ct->mon, ct->day, ct->hour, ct->min, ct->sec); 412 #endif /* RTCDEBUG */ 413 } 414 415 416 void 417 clock_set(dev, ct) 418 struct device *dev; 419 struct clocktime *ct; 420 { 421 struct vrrtc_softc *sc = (struct vrrtc_softc *)dev; 422 u_long timeh; /* elapse time (2*timeh sec) */ 423 u_long timel; /* timel/32768 sec */ 424 int year, month, sec2; 425 426 timeh = 0; 427 timel = 0; 428 429 #ifdef RTCDEBUG 430 printf("clock_set: %d/%d/%d/%d/%d/%d\n", 431 ct->year, ct->mon, ct->day, ct->hour, ct->min, ct->sec); 432 #endif /* RTCDEBUG */ 433 ct->year += 1900; 434 #ifdef RTCDEBUG 435 printf("clock_set: %d/%d/%d/%d/%d/%d\n", 436 ct->year, ct->mon, ct->day, ct->hour, ct->min, ct->sec); 437 #endif /* RTCDEBUG */ 438 year = EPOCHYEAR; 439 sec2 = LEAPYEAR4(year)?(SECYR+SECDAY)/2:SECYR/2; 440 while (year < ct->year) { 441 year++; 442 timeh += sec2; 443 sec2 = LEAPYEAR4(year)?(SECYR+SECDAY)/2:SECYR/2; 444 } 445 month = 1; /* now month is 1..12 */ 446 sec2 = (SECDAY * m2d[month-1])/2; 447 while (month < ct->mon) { 448 month++; 449 timeh += sec2; 450 sec2 = (SECDAY * m2d[month-1])/2; 451 if (month == 2 && LEAPYEAR4(year)) /* feb. and leapyear */ 452 sec2 += SECDAY/2; 453 } 454 455 timeh += (ct->day - 1)*(SECDAY/2); 456 457 timeh += ct->hour*(SECHOUR/2); 458 459 timeh += ct->min*(SECMIN/2); 460 461 timeh += ct->sec/2; 462 timel += (ct->sec%2)*ETIME_L_HZ; 463 464 timeh += EPOCHOFF; 465 timeh -= (rtc_offset*(SECMIN/2)); 466 467 #ifdef RTCDEBUG 468 cvt_timehl_ct(timeh, timel, NULL); 469 #endif /* RTCDEBUG */ 470 471 bus_space_write_2(sc->sc_iot, sc->sc_ioh, 472 ETIME_H_REG_W, (timeh>>16)&0xffff); 473 bus_space_write_2(sc->sc_iot, sc->sc_ioh, ETIME_M_REG_W, timeh&0xffff); 474 bus_space_write_2(sc->sc_iot, sc->sc_ioh, ETIME_L_REG_W, timel); 475 476 } 477 478
Indexes created Tue Sep 30 11:09:46 GMT 2025