开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
time.c
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：16k
源码类别：

嵌入式Linux

开发平台：

Unix_Linux

time.c：源码内容
  1. /* $Id: time.c,v 1.59.2.1 2002/01/23 14:35:45 davem Exp $
  2.  * linux/arch/sparc/kernel/time.c
  3.  *
  4.  * Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu)
  5.  * Copyright (C) 1996 Thomas K. Dyas (tdyas@eden.rutgers.edu)
  6.  *
  7.  * Chris Davis (cdavis@cois.on.ca) 03/27/1998
  8.  * Added support for the intersil on the sun4/4200
  9.  *
  10.  * Gleb Raiko (rajko@mech.math.msu.su) 08/18/1998
  11.  * Support for MicroSPARC-IIep, PCI CPU.
  12.  *
  13.  * This file handles the Sparc specific time handling details.
  14.  *
  15.  * 1997-09-10 Updated NTP code according to technical memorandum Jan '96
  16.  * "A Kernel Model for Precision Timekeeping" by Dave Mills
  17.  */
  18. #include <linux/config.h>
  19. #include <linux/errno.h>
  20. #include <linux/sched.h>
  21. #include <linux/kernel.h>
  22. #include <linux/param.h>
  23. #include <linux/string.h>
  24. #include <linux/mm.h>
  25. #include <linux/interrupt.h>
  26. #include <linux/timex.h>
  27. #include <linux/init.h>
  28. #include <linux/pci.h>
  29. #include <linux/ioport.h>
  31. #include <asm/oplib.h>
  32. #include <asm/segment.h>
  33. #include <asm/timer.h>
  34. #include <asm/mostek.h>
  35. #include <asm/system.h>
  36. #include <asm/irq.h>
  37. #include <asm/io.h>
  38. #include <asm/idprom.h>
  39. #include <asm/machines.h>
  40. #include <asm/sun4paddr.h>
  41. #include <asm/page.h>
  42. #include <asm/pcic.h>
  44. extern rwlock_t xtime_lock;
  46. enum sparc_clock_type sp_clock_typ;
  47. spinlock_t mostek_lock = SPIN_LOCK_UNLOCKED;
  48. unsigned long mstk48t02_regs = 0UL;
  49. static struct mostek48t08 *mstk48t08_regs = 0;
  50. static int set_rtc_mmss(unsigned long);
  51. static void sbus_do_settimeofday(struct timeval *tv);
  53. #ifdef CONFIG_SUN4
  54. struct intersil *intersil_clock;
  55. #define intersil_cmd(intersil_reg, intsil_cmd) intersil_reg->int_cmd_reg = 
  56. (intsil_cmd)
  58. #define intersil_intr(intersil_reg, intsil_cmd) intersil_reg->int_intr_reg = 
  59. (intsil_cmd)
  61. #define intersil_start(intersil_reg) intersil_cmd(intersil_reg, 
  62. ( INTERSIL_START | INTERSIL_32K | INTERSIL_NORMAL | INTERSIL_24H |
  63.   INTERSIL_INTR_ENABLE))
  65. #define intersil_stop(intersil_reg) intersil_cmd(intersil_reg, 
  66. ( INTERSIL_STOP | INTERSIL_32K | INTERSIL_NORMAL | INTERSIL_24H |
  67.   INTERSIL_INTR_ENABLE))
  69. #define intersil_read_intr(intersil_reg, towhere) towhere = 
  70. intersil_reg->int_intr_reg
  72. #endif
  74. static spinlock_t ticker_lock = SPIN_LOCK_UNLOCKED;
  76. /* 32-bit Sparc specific profiling function. */
  77. void sparc_do_profile(unsigned long pc, unsigned long o7)
  78. {
  79. if(prof_buffer && current->pid) {
  80. extern int _stext;
  81. extern int __copy_user_begin, __copy_user_end;
  82. extern int __atomic_begin, __atomic_end;
  83. extern int __bzero_begin, __bzero_end;
  84. extern int __bitops_begin, __bitops_end;
  86. if ((pc >= (unsigned long) &__copy_user_begin &&
  87.      pc < (unsigned long) &__copy_user_end) ||
  88.     (pc >= (unsigned long) &__atomic_begin &&
  89.      pc < (unsigned long) &__atomic_end) ||
  90.     (pc >= (unsigned long) &__bzero_begin &&
  91.      pc < (unsigned long) &__bzero_end) ||
  92.     (pc >= (unsigned long) &__bitops_begin &&
  93.      pc < (unsigned long) &__bitops_end))
  94. pc = o7;
  96. pc -= (unsigned long) &_stext;
  97. pc >>= prof_shift;
  99. spin_lock(&ticker_lock);
  100. if(pc < prof_len)
  101. prof_buffer[pc]++;
  102. else
  103. prof_buffer[prof_len - 1]++;
  104. spin_unlock(&ticker_lock);
  105. }
  106. }
  108. __volatile__ unsigned int *master_l10_counter;
  109. __volatile__ unsigned int *master_l10_limit;
  111. /*
  112.  * timer_interrupt() needs to keep up the real-time clock,
  113.  * as well as call the "do_timer()" routine every clocktick
  114.  */
  115. void timer_interrupt(int irq, void *dev_id, struct pt_regs * regs)
  116. {
  117. /* last time the cmos clock got updated */
  118. static long last_rtc_update=0;
  120. #ifndef CONFIG_SMP
  121. if(!user_mode(regs))
  122. sparc_do_profile(regs->pc, regs->u_regs[UREG_RETPC]);
  123. #endif
  125. #ifdef CONFIG_SUN4
  126. if((idprom->id_machtype == (SM_SUN4 | SM_4_260)) ||
  127.    (idprom->id_machtype == (SM_SUN4 | SM_4_110))) {
  128. int temp;
  129.          intersil_read_intr(intersil_clock, temp);
  130. /* re-enable the irq */
  131. enable_pil_irq(10);
  132. }
  133. #endif
  134. clear_clock_irq();
  136. write_lock(&xtime_lock);
  138. do_timer(regs);
  140. /* Determine when to update the Mostek clock. */
  141. if ((time_status & STA_UNSYNC) == 0 &&
  142.     xtime.tv_sec > last_rtc_update + 660 &&
  143.     xtime.tv_usec >= 500000 - ((unsigned) tick) / 2 &&
  144.     xtime.tv_usec <= 500000 + ((unsigned) tick) / 2) {
  145.   if (set_rtc_mmss(xtime.tv_sec) == 0)
  146.     last_rtc_update = xtime.tv_sec;
  147.   else
  148.     last_rtc_update = xtime.tv_sec - 600; /* do it again in 60 s */
  149. }
  150. write_unlock(&xtime_lock);
  151. }
  153. /* Kick start a stopped clock (procedure from the Sun NVRAM/hostid FAQ). */
  154. static void __init kick_start_clock(void)
  155. {
  156. struct mostek48t02 *regs = (struct mostek48t02 *)mstk48t02_regs;
  157. unsigned char sec;
  158. int i, count;
  160. prom_printf("CLOCK: Clock was stopped. Kick start ");
  162. spin_lock_irq(&mostek_lock);
  164. /* Turn on the kick start bit to start the oscillator. */
  165. regs->creg |= MSTK_CREG_WRITE;
  166. regs->sec &= ~MSTK_STOP;
  167. regs->hour |= MSTK_KICK_START;
  168. regs->creg &= ~MSTK_CREG_WRITE;
  170. spin_unlock_irq(&mostek_lock);
  172. /* Delay to allow the clock oscillator to start. */
  173. sec = MSTK_REG_SEC(regs);
  174. for (i = 0; i < 3; i++) {
  175. while (sec == MSTK_REG_SEC(regs))
  176. for (count = 0; count < 100000; count++)
  177. /* nothing */ ;
  178. prom_printf(".");
  179. sec = regs->sec;
  180. }
  181. prom_printf("n");
  183. spin_lock_irq(&mostek_lock);
  185. /* Turn off kick start and set a "valid" time and date. */
  186. regs->creg |= MSTK_CREG_WRITE;
  187. regs->hour &= ~MSTK_KICK_START;
  188. MSTK_SET_REG_SEC(regs,0);
  189. MSTK_SET_REG_MIN(regs,0);
  190. MSTK_SET_REG_HOUR(regs,0);
  191. MSTK_SET_REG_DOW(regs,5);
  192. MSTK_SET_REG_DOM(regs,1);
  193. MSTK_SET_REG_MONTH(regs,8);
  194. MSTK_SET_REG_YEAR(regs,1996 - MSTK_YEAR_ZERO);
  195. regs->creg &= ~MSTK_CREG_WRITE;
  197. spin_unlock_irq(&mostek_lock);
  199. /* Ensure the kick start bit is off. If it isn't, turn it off. */
  200. while (regs->hour & MSTK_KICK_START) {
  201. prom_printf("CLOCK: Kick start still on!n");
  203. spin_lock_irq(&mostek_lock);
  204. regs->creg |= MSTK_CREG_WRITE;
  205. regs->hour &= ~MSTK_KICK_START;
  206. regs->creg &= ~MSTK_CREG_WRITE;
  207. spin_unlock_irq(&mostek_lock);
  208. }
  210. prom_printf("CLOCK: Kick start procedure successful.n");
  211. }
  213. /* Return nonzero if the clock chip battery is low. */
  214. static __inline__ int has_low_battery(void)
  215. {
  216. struct mostek48t02 *regs = (struct mostek48t02 *)mstk48t02_regs;
  217. unsigned char data1, data2;
  219. spin_lock_irq(&mostek_lock);
  220. data1 = regs->eeprom[0]; /* Read some data. */
  221. regs->eeprom[0] = ~data1; /* Write back the complement. */
  222. data2 = regs->eeprom[0]; /* Read back the complement. */
  223. regs->eeprom[0] = data1; /* Restore the original value. */
  224. spin_unlock_irq(&mostek_lock);
  226. return (data1 == data2); /* Was the write blocked? */
  227. }
  229. /* Probe for the real time clock chip on Sun4 */
  230. static __inline__ void sun4_clock_probe(void)
  231. {
  232. #ifdef CONFIG_SUN4
  233. int temp;
  234. struct resource r;
  236. memset(&r, 0, sizeof(r));
  237. if( idprom->id_machtype == (SM_SUN4 | SM_4_330) ) {
  238. sp_clock_typ = MSTK48T02;
  239. r.start = sun4_clock_physaddr;
  240. mstk48t02_regs = sbus_ioremap(&r, 0,
  241.        sizeof(struct mostek48t02), 0);
  242. mstk48t08_regs = 0;  /* To catch weirdness */
  243. intersil_clock = 0;  /* just in case */
  245. /* Kick start the clock if it is completely stopped. */
  246. if (mostek_read(mstk48t02_regs + MOSTEK_SEC) & MSTK_STOP)
  247. kick_start_clock();
  248. } else if( idprom->id_machtype == (SM_SUN4 | SM_4_260)) {
  249. /* intersil setup code */
  250. printk("Clock: INTERSIL at %8x ",sun4_clock_physaddr);
  251. sp_clock_typ = INTERSIL;
  252. r.start = sun4_clock_physaddr;
  253. intersil_clock = (struct intersil *) 
  254.     sbus_ioremap(&r, 0, sizeof(*intersil_clock), "intersil");
  255. mstk48t02_regs = 0;  /* just be sure */
  256. mstk48t08_regs = 0;  /* ditto */
  257. /* initialise the clock */
  259. intersil_intr(intersil_clock,INTERSIL_INT_100HZ);
  261. intersil_start(intersil_clock);
  263. intersil_read_intr(intersil_clock, temp);
  264.                 while (!(temp & 0x80))
  265.                         intersil_read_intr(intersil_clock, temp);
  267.                 intersil_read_intr(intersil_clock, temp);
  268.                 while (!(temp & 0x80))
  269.                         intersil_read_intr(intersil_clock, temp);
  271. intersil_stop(intersil_clock);
  273. }
  274. #endif
  275. }
  277. /* Probe for the mostek real time clock chip. */
  278. static __inline__ void clock_probe(void)
  279. {
  280. struct linux_prom_registers clk_reg[2];
  281. char model[128];
  282. register int node, cpuunit, bootbus;
  283. struct resource r;
  285. cpuunit = bootbus = 0;
  286. memset(&r, 0, sizeof(r));
  288. /* Determine the correct starting PROM node for the probe. */
  289. node = prom_getchild(prom_root_node);
  290. switch (sparc_cpu_model) {
  291. case sun4c:
  292. break;
  293. case sun4m:
  294. node = prom_getchild(prom_searchsiblings(node, "obio"));
  295. break;
  296. case sun4d:
  297. node = prom_getchild(bootbus = prom_searchsiblings(prom_getchild(cpuunit = prom_searchsiblings(node, "cpu-unit")), "bootbus"));
  298. break;
  299. default:
  300. prom_printf("CLOCK: Unsupported architecture!n");
  301. prom_halt();
  302. }
  304. /* Find the PROM node describing the real time clock. */
  305. sp_clock_typ = MSTK_INVALID;
  306. node = prom_searchsiblings(node,"eeprom");
  307. if (!node) {
  308. prom_printf("CLOCK: No clock found!n");
  309. prom_halt();
  310. }
  312. /* Get the model name and setup everything up. */
  313. model[0] = '';
  314. prom_getstring(node, "model", model, sizeof(model));
  315. if (strcmp(model, "mk48t02") == 0) {
  316. sp_clock_typ = MSTK48T02;
  317. if (prom_getproperty(node, "reg", (char *) clk_reg, sizeof(clk_reg)) == -1) {
  318. prom_printf("clock_probe: FAILED!n");
  319. prom_halt();
  320. }
  321. if (sparc_cpu_model == sun4d)
  322. prom_apply_generic_ranges (bootbus, cpuunit, clk_reg, 1);
  323. else
  324. prom_apply_obio_ranges(clk_reg, 1);
  325. /* Map the clock register io area read-only */
  326. r.flags = clk_reg[0].which_io;
  327. r.start = clk_reg[0].phys_addr;
  328. mstk48t02_regs = sbus_ioremap(&r, 0,
  329.     sizeof(struct mostek48t02), "mk48t02");
  330. mstk48t08_regs = 0;  /* To catch weirdness */
  331. } else if (strcmp(model, "mk48t08") == 0) {
  332. sp_clock_typ = MSTK48T08;
  333. if(prom_getproperty(node, "reg", (char *) clk_reg,
  334.     sizeof(clk_reg)) == -1) {
  335. prom_printf("clock_probe: FAILED!n");
  336. prom_halt();
  337. }
  338. if (sparc_cpu_model == sun4d)
  339. prom_apply_generic_ranges (bootbus, cpuunit, clk_reg, 1);
  340. else
  341. prom_apply_obio_ranges(clk_reg, 1);
  342. /* Map the clock register io area read-only */
  343. /* XXX r/o attribute is somewhere in r.flags */
  344. r.flags = clk_reg[0].which_io;
  345. r.start = clk_reg[0].phys_addr;
  346. mstk48t08_regs = (struct mostek48t08 *) sbus_ioremap(&r, 0,
  347.     sizeof(struct mostek48t08), "mk48t08");
  349. mstk48t02_regs = (unsigned long)&mstk48t08_regs->regs;
  350. } else {
  351. prom_printf("CLOCK: Unknown model name '%s'n",model);
  352. prom_halt();
  353. }
  355. /* Report a low battery voltage condition. */
  356. if (has_low_battery())
  357. printk(KERN_CRIT "NVRAM: Low battery voltage!n");
  359. /* Kick start the clock if it is completely stopped. */
  360. if (mostek_read(mstk48t02_regs + MOSTEK_SEC) & MSTK_STOP)
  361. kick_start_clock();
  362. }
  364. void __init sbus_time_init(void)
  365. {
  366. unsigned int year, mon, day, hour, min, sec;
  367. struct mostek48t02 *mregs;
  369. #ifdef CONFIG_SUN4
  370. int temp;
  371. struct intersil *iregs;
  372. #endif
  374. BTFIXUPSET_CALL(bus_do_settimeofday, sbus_do_settimeofday, BTFIXUPCALL_NORM);
  375. btfixup();
  377. if (ARCH_SUN4)
  378. sun4_clock_probe();
  379. else
  380. clock_probe();
  382. init_timers(timer_interrupt);
  384. #ifdef CONFIG_SUN4
  385. if(idprom->id_machtype == (SM_SUN4 | SM_4_330)) {
  386. #endif
  387. mregs = (struct mostek48t02 *)mstk48t02_regs;
  388. if(!mregs) {
  389. prom_printf("Something wrong, clock regs not mapped yet.n");
  390. prom_halt();
  391. }
  392. spin_lock_irq(&mostek_lock);
  393. mregs->creg |= MSTK_CREG_READ;
  394. sec = MSTK_REG_SEC(mregs);
  395. min = MSTK_REG_MIN(mregs);
  396. hour = MSTK_REG_HOUR(mregs);
  397. day = MSTK_REG_DOM(mregs);
  398. mon = MSTK_REG_MONTH(mregs);
  399. year = MSTK_CVT_YEAR( MSTK_REG_YEAR(mregs) );
  400. xtime.tv_sec = mktime(year, mon, day, hour, min, sec);
  401. xtime.tv_usec = 0;
  402. mregs->creg &= ~MSTK_CREG_READ;
  403. spin_unlock_irq(&mostek_lock);
  404. #ifdef CONFIG_SUN4
  405. } else if(idprom->id_machtype == (SM_SUN4 | SM_4_260) ) {
  406. /* initialise the intersil on sun4 */
  408. iregs=intersil_clock;
  409. if(!iregs) {
  410. prom_printf("Something wrong, clock regs not mapped yet.n");
  411. prom_halt();
  412. }
  414. intersil_intr(intersil_clock,INTERSIL_INT_100HZ);
  415. disable_pil_irq(10);
  416. intersil_stop(iregs);
  417. intersil_read_intr(intersil_clock, temp);
  419. temp = iregs->clk.int_csec;
  421. sec = iregs->clk.int_sec;
  422. min = iregs->clk.int_min;
  423. hour = iregs->clk.int_hour;
  424. day = iregs->clk.int_day;
  425. mon = iregs->clk.int_month;
  426. year = MSTK_CVT_YEAR(iregs->clk.int_year);
  428. enable_pil_irq(10);
  429. intersil_start(iregs);
  431. xtime.tv_sec = mktime(year, mon, day, hour, min, sec);
  432. xtime.tv_usec = 0;
  433. printk("%u/%u/%u %u:%u:%un",day,mon,year,hour,min,sec);
  434. }
  435. #endif
  437. /* Now that OBP ticker has been silenced, it is safe to enable IRQ. */
  438. __sti();
  439. }
  441. void __init time_init(void)
  442. {
  443. #ifdef CONFIG_PCI
  444. extern void pci_time_init(void);
  445. if (pcic_present()) {
  446. pci_time_init();
  447. return;
  448. }
  449. #endif
  450. sbus_time_init();
  451. }
  453. extern __inline__ unsigned long do_gettimeoffset(void)
  454. {
  455. struct tasklet_struct *t;
  456. unsigned long offset = 0;
  457. unsigned int count;
  459. count = (*master_l10_counter >> 10) & 0x1fffff;
  461. t = &bh_task_vec[TIMER_BH];
  462. if (test_bit(TASKLET_STATE_SCHED, &t->state))
  463. offset = 1000000;
  465. return offset + count;
  466. }
  468. /* This need not obtain the xtime_lock as it is coded in
  469.  * an implicitly SMP safe way already.
  470.  */
  471. void do_gettimeofday(struct timeval *tv)
  472. {
  473. /* Load doubles must be used on xtime so that what we get
  474.  * is guarenteed to be atomic, this is why we can run this
  475.  * with interrupts on full blast.  Don't touch this... -DaveM
  476.  */
  477. __asm__ __volatile__(
  478. "sethi %hi(master_l10_counter), %o1nt"
  479. "ld [%o1 + %lo(master_l10_counter)], %g3nt"
  480. "sethi %hi(xtime), %g2n"
  481. "1:nt"
  482. "ldd [%g2 + %lo(xtime)], %o4nt"
  483. "ld [%g3], %o1nt"
  484. "ldd [%g2 + %lo(xtime)], %o2nt"
  485. "xor %o4, %o2, %o2nt"
  486. "xor %o5, %o3, %o3nt"
  487. "orcc %o2, %o3, %g0nt"
  488. "bne 1bnt"
  489. " cmp %o1, 0nt"
  490. "bge 1fnt"
  491. " srl %o1, 0xa, %o1nt"
  492. "sethi %hi(tick), %o3nt"
  493. "ld [%o3 + %lo(tick)], %o3nt"
  494. "sethi %hi(0x1fffff), %o2nt"
  495. "or %o2, %lo(0x1fffff), %o2nt"
  496. "add %o5, %o3, %o5nt"
  497. "and %o1, %o2, %o1n"
  498. "1:nt"
  499. "add %o5, %o1, %o5nt"
  500. "sethi %hi(1000000), %o2nt"
  501. "or %o2, %lo(1000000), %o2nt"
  502. "cmp %o5, %o2nt"
  503. "bl,a 1fnt"
  504. " st %o4, [%o0 + 0x0]nt"
  505. "add %o4, 0x1, %o4nt"
  506. "sub %o5, %o2, %o5nt"
  507. "st %o4, [%o0 + 0x0]n"
  508. "1:nt"
  509. "st %o5, [%o0 + 0x4]n");
  510. }
  512. void do_settimeofday(struct timeval *tv)
  513. {
  514. write_lock_irq(&xtime_lock);
  515. bus_do_settimeofday(tv);
  516. write_unlock_irq(&xtime_lock);
  517. }
  519. static void sbus_do_settimeofday(struct timeval *tv)
  520. {
  521. tv->tv_usec -= do_gettimeoffset();
  522. if(tv->tv_usec < 0) {
  523. tv->tv_usec += 1000000;
  524. tv->tv_sec--;
  525. }
  526. xtime = *tv;
  527. time_adjust = 0; /* stop active adjtime() */
  528. time_status |= STA_UNSYNC;
  529. time_maxerror = NTP_PHASE_LIMIT;
  530. time_esterror = NTP_PHASE_LIMIT;
  531. }
  533. /*
  534.  * BUG: This routine does not handle hour overflow properly; it just
  535.  *      sets the minutes. Usually you won't notice until after reboot!
  536.  */
  537. static int set_rtc_mmss(unsigned long nowtime)
  538. {
  539. int real_seconds, real_minutes, mostek_minutes;
  540. struct mostek48t02 *regs = (struct mostek48t02 *)mstk48t02_regs;
  541. unsigned long flags;
  542. #ifdef CONFIG_SUN4
  543. struct intersil *iregs = intersil_clock;
  544. int temp;
  545. #endif
  547. /* Not having a register set can lead to trouble. */
  548. if (!regs) {
  549. #ifdef CONFIG_SUN4
  550. if(!iregs)
  551. return -1;
  552.   else {
  553. temp = iregs->clk.int_csec;
  555. mostek_minutes = iregs->clk.int_min;
  557. real_seconds = nowtime % 60;
  558. real_minutes = nowtime / 60;
  559. if (((abs(real_minutes - mostek_minutes) + 15)/30) & 1)
  560. real_minutes += 30; /* correct for half hour time zone */
  561. real_minutes %= 60;
  563. if (abs(real_minutes - mostek_minutes) < 30) {
  564. intersil_stop(iregs);
  565. iregs->clk.int_sec=real_seconds;
  566. iregs->clk.int_min=real_minutes;
  567. intersil_start(iregs);
  568. } else {
  569. printk(KERN_WARNING
  570.        "set_rtc_mmss: can't update from %d to %dn",
  571.        mostek_minutes, real_minutes);
  572. return -1;
  573. }
  575. return 0;
  576. }
  577. #endif
  578. }
  580. spin_lock_irqsave(&mostek_lock, flags);
  581. /* Read the current RTC minutes. */
  582. regs->creg |= MSTK_CREG_READ;
  583. mostek_minutes = MSTK_REG_MIN(regs);
  584. regs->creg &= ~MSTK_CREG_READ;
  586. /*
  587.  * since we're only adjusting minutes and seconds,
  588.  * don't interfere with hour overflow. This avoids
  589.  * messing with unknown time zones but requires your
  590.  * RTC not to be off by more than 15 minutes
  591.  */
  592. real_seconds = nowtime % 60;
  593. real_minutes = nowtime / 60;
  594. if (((abs(real_minutes - mostek_minutes) + 15)/30) & 1)
  595. real_minutes += 30; /* correct for half hour time zone */
  596. real_minutes %= 60;
  598. if (abs(real_minutes - mostek_minutes) < 30) {
  599. regs->creg |= MSTK_CREG_WRITE;
  600. MSTK_SET_REG_SEC(regs,real_seconds);
  601. MSTK_SET_REG_MIN(regs,real_minutes);
  602. regs->creg &= ~MSTK_CREG_WRITE;
  603. spin_unlock_irqrestore(&mostek_lock, flags);
  604. return 0;
  605. } else {
  606. spin_unlock_irqrestore(&mostek_lock, flags);
  607. return -1;
  608. }
  609. }