diff options
Diffstat (limited to 'arch/sparc/kernel/time.c')
| -rw-r--r-- | arch/sparc/kernel/time.c | 74 |
1 files changed, 42 insertions, 32 deletions
diff --git a/arch/sparc/kernel/time.c b/arch/sparc/kernel/time.c index 04eb1eab6e3e..845081b01267 100644 --- a/arch/sparc/kernel/time.c +++ b/arch/sparc/kernel/time.c | |||
| @@ -225,6 +225,32 @@ static __inline__ int has_low_battery(void) | |||
| 225 | return (data1 == data2); /* Was the write blocked? */ | 225 | return (data1 == data2); /* Was the write blocked? */ |
| 226 | } | 226 | } |
| 227 | 227 | ||
| 228 | static void __init mostek_set_system_time(void) | ||
| 229 | { | ||
| 230 | unsigned int year, mon, day, hour, min, sec; | ||
| 231 | struct mostek48t02 *mregs; | ||
| 232 | |||
| 233 | mregs = (struct mostek48t02 *)mstk48t02_regs; | ||
| 234 | if(!mregs) { | ||
| 235 | prom_printf("Something wrong, clock regs not mapped yet.\n"); | ||
| 236 | prom_halt(); | ||
| 237 | } | ||
| 238 | spin_lock_irq(&mostek_lock); | ||
| 239 | mregs->creg |= MSTK_CREG_READ; | ||
| 240 | sec = MSTK_REG_SEC(mregs); | ||
| 241 | min = MSTK_REG_MIN(mregs); | ||
| 242 | hour = MSTK_REG_HOUR(mregs); | ||
| 243 | day = MSTK_REG_DOM(mregs); | ||
| 244 | mon = MSTK_REG_MONTH(mregs); | ||
| 245 | year = MSTK_CVT_YEAR( MSTK_REG_YEAR(mregs) ); | ||
| 246 | xtime.tv_sec = mktime(year, mon, day, hour, min, sec); | ||
| 247 | xtime.tv_nsec = (INITIAL_JIFFIES % HZ) * (NSEC_PER_SEC / HZ); | ||
| 248 | set_normalized_timespec(&wall_to_monotonic, | ||
| 249 | -xtime.tv_sec, -xtime.tv_nsec); | ||
| 250 | mregs->creg &= ~MSTK_CREG_READ; | ||
| 251 | spin_unlock_irq(&mostek_lock); | ||
| 252 | } | ||
| 253 | |||
| 228 | /* Probe for the real time clock chip on Sun4 */ | 254 | /* Probe for the real time clock chip on Sun4 */ |
| 229 | static __inline__ void sun4_clock_probe(void) | 255 | static __inline__ void sun4_clock_probe(void) |
| 230 | { | 256 | { |
| @@ -273,6 +299,7 @@ static __inline__ void sun4_clock_probe(void) | |||
| 273 | #endif | 299 | #endif |
| 274 | } | 300 | } |
| 275 | 301 | ||
| 302 | #ifndef CONFIG_SUN4 | ||
| 276 | static int __devinit clock_probe(struct of_device *op, const struct of_device_id *match) | 303 | static int __devinit clock_probe(struct of_device *op, const struct of_device_id *match) |
| 277 | { | 304 | { |
| 278 | struct device_node *dp = op->node; | 305 | struct device_node *dp = op->node; |
| @@ -307,6 +334,8 @@ static int __devinit clock_probe(struct of_device *op, const struct of_device_id | |||
| 307 | if (mostek_read(mstk48t02_regs + MOSTEK_SEC) & MSTK_STOP) | 334 | if (mostek_read(mstk48t02_regs + MOSTEK_SEC) & MSTK_STOP) |
| 308 | kick_start_clock(); | 335 | kick_start_clock(); |
| 309 | 336 | ||
| 337 | mostek_set_system_time(); | ||
| 338 | |||
| 310 | return 0; | 339 | return 0; |
| 311 | } | 340 | } |
| 312 | 341 | ||
| @@ -325,56 +354,37 @@ static struct of_platform_driver clock_driver = { | |||
| 325 | 354 | ||
| 326 | 355 | ||
| 327 | /* Probe for the mostek real time clock chip. */ | 356 | /* Probe for the mostek real time clock chip. */ |
| 328 | static void clock_init(void) | 357 | static int __init clock_init(void) |
| 329 | { | 358 | { |
| 330 | of_register_driver(&clock_driver, &of_bus_type); | 359 | return of_register_driver(&clock_driver, &of_bus_type); |
| 331 | } | 360 | } |
| 332 | 361 | ||
| 362 | /* Must be after subsys_initcall() so that busses are probed. Must | ||
| 363 | * be before device_initcall() because things like the RTC driver | ||
| 364 | * need to see the clock registers. | ||
| 365 | */ | ||
| 366 | fs_initcall(clock_init); | ||
| 367 | #endif /* !CONFIG_SUN4 */ | ||
| 368 | |||
| 333 | void __init sbus_time_init(void) | 369 | void __init sbus_time_init(void) |
| 334 | { | 370 | { |
| 335 | unsigned int year, mon, day, hour, min, sec; | ||
| 336 | struct mostek48t02 *mregs; | ||
| 337 | |||
| 338 | #ifdef CONFIG_SUN4 | ||
| 339 | int temp; | ||
| 340 | struct intersil *iregs; | ||
| 341 | #endif | ||
| 342 | 371 | ||
| 343 | BTFIXUPSET_CALL(bus_do_settimeofday, sbus_do_settimeofday, BTFIXUPCALL_NORM); | 372 | BTFIXUPSET_CALL(bus_do_settimeofday, sbus_do_settimeofday, BTFIXUPCALL_NORM); |
| 344 | btfixup(); | 373 | btfixup(); |
| 345 | 374 | ||
| 346 | if (ARCH_SUN4) | 375 | if (ARCH_SUN4) |
| 347 | sun4_clock_probe(); | 376 | sun4_clock_probe(); |
| 348 | else | ||
| 349 | clock_init(); | ||
| 350 | 377 | ||
| 351 | sparc_init_timers(timer_interrupt); | 378 | sparc_init_timers(timer_interrupt); |
| 352 | 379 | ||
| 353 | #ifdef CONFIG_SUN4 | 380 | #ifdef CONFIG_SUN4 |
| 354 | if(idprom->id_machtype == (SM_SUN4 | SM_4_330)) { | 381 | if(idprom->id_machtype == (SM_SUN4 | SM_4_330)) { |
| 355 | #endif | 382 | mostek_set_system_time(); |
| 356 | mregs = (struct mostek48t02 *)mstk48t02_regs; | ||
| 357 | if(!mregs) { | ||
| 358 | prom_printf("Something wrong, clock regs not mapped yet.\n"); | ||
| 359 | prom_halt(); | ||
| 360 | } | ||
| 361 | spin_lock_irq(&mostek_lock); | ||
| 362 | mregs->creg |= MSTK_CREG_READ; | ||
| 363 | sec = MSTK_REG_SEC(mregs); | ||
| 364 | min = MSTK_REG_MIN(mregs); | ||
| 365 | hour = MSTK_REG_HOUR(mregs); | ||
| 366 | day = MSTK_REG_DOM(mregs); | ||
| 367 | mon = MSTK_REG_MONTH(mregs); | ||
| 368 | year = MSTK_CVT_YEAR( MSTK_REG_YEAR(mregs) ); | ||
| 369 | xtime.tv_sec = mktime(year, mon, day, hour, min, sec); | ||
| 370 | xtime.tv_nsec = (INITIAL_JIFFIES % HZ) * (NSEC_PER_SEC / HZ); | ||
| 371 | set_normalized_timespec(&wall_to_monotonic, | ||
| 372 | -xtime.tv_sec, -xtime.tv_nsec); | ||
| 373 | mregs->creg &= ~MSTK_CREG_READ; | ||
| 374 | spin_unlock_irq(&mostek_lock); | ||
| 375 | #ifdef CONFIG_SUN4 | ||
| 376 | } else if(idprom->id_machtype == (SM_SUN4 | SM_4_260) ) { | 383 | } else if(idprom->id_machtype == (SM_SUN4 | SM_4_260) ) { |
| 377 | /* initialise the intersil on sun4 */ | 384 | /* initialise the intersil on sun4 */ |
| 385 | unsigned int year, mon, day, hour, min, sec; | ||
| 386 | int temp; | ||
| 387 | struct intersil *iregs; | ||
| 378 | 388 | ||
| 379 | iregs=intersil_clock; | 389 | iregs=intersil_clock; |
| 380 | if(!iregs) { | 390 | if(!iregs) { |
