Return to delay.c CVS log

Up to [local] / sys / arch / landisk / stand / boot

Annotation of sys/arch/landisk/stand/boot/delay.c, Revision 1.1.1.1

1.1       nbrk        1: /*     $OpenBSD: delay.c,v 1.1 2006/10/06 21:48:50 mickey Exp $        */
                      2: /*     $NetBSD: delay.c,v 1.1 2006/09/01 21:26:18 uwe Exp $    */
                      3:
                      4: /*-
                      5:  * Copyright (c) 2005 NONAKA Kimihiro
                      6:  * 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:  *
                     17:  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
                     18:  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
                     19:  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
                     20:  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
                     21:  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
                     22:  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
                     23:  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
                     24:  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
                     25:  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
                     26:  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
                     27:  * SUCH DAMAGE.
                     28:  */
                     29:
                     30: #include <sys/param.h>
                     31: #include <libsa.h>
                     32:
                     33: #include <sh/tmureg.h>
                     34:
                     35: #ifndef        TICK_CH
                     36: #define        TICK_CH 0
                     37: #endif
                     38: #if TICK_CH == 0
                     39: #define        TSTR    SH4_TSTR
                     40: #define        TCOR    SH4_TCOR0
                     41: #define        TCNT    SH4_TCNT0
                     42: #define        TCR     SH4_TCR0
                     43: #define        TSTR_CH TSTR_STR0
                     44: #elif TICK_CH == 1
                     45: #define        TSTR    SH4_TSTR
                     46: #define        TCOR    SH4_TCOR1
                     47: #define        TCNT    SH4_TCNT1
                     48: #define        TCR     SH4_TCR1
                     49: #define        TSTR_CH TSTR_STR1
                     50: #elif TICK_CH == 2
                     51: #define        TSTR    SH4_TSTR
                     52: #define        TCOR    SH4_TCOR2
                     53: #define        TCNT    SH4_TCNT2
                     54: #define        TCR     SH4_TCR2
                     55: #define        TSTR_CH TSTR_STR2
                     56: #elif TICK_CH == 3
                     57: #define        TSTR    SH4_TSTR2
                     58: #define        TCOR    SH4_TCOR3
                     59: #define        TCNT    SH4_TCNT3
                     60: #define        TCR     SH4_TCR3
                     61: #define        TSTR_CH SH4_TSTR2_STR3
                     62: #elif TICK_CH == 4
                     63: #define        TSTR    SH4_TSTR2
                     64: #define        TCOR    SH4_TCOR4
                     65: #define        TCNT    SH4_TCNT4
                     66: #define        TCR     SH4_TCR4
                     67: #define        TSTR_CH SH4_TSTR2_STR4
                     68: #else
                     69: #error TICK_CH != [01234]
                     70: #endif
                     71:
                     72: #ifndef        TICK_PRESC
                     73: #define        TICK_PRESC      1024
                     74: #endif
                     75: #if TICK_PRESC == 4
                     76: #define        TCR_TPSC        TCR_TPSC_P4
                     77: #elif TICK_PRESC == 16
                     78: #define        TCR_TPSC        TCR_TPSC_P16
                     79: #elif TICK_PRESC == 64
                     80: #define        TCR_TPSC        TCR_TPSC_P64
                     81: #elif TICK_PRESC == 256
                     82: #define        TCR_TPSC        TCR_TPSC_P256
                     83: #elif TICK_PRESC == 1024
                     84: #define        TCR_TPSC        SH4_TCR_TPSC_P1024
                     85: #else
                     86: #error TICK_PRESC != 4, 16, 64, 256, 1024
                     87: #endif
                     88:
                     89: #define        TICKS_PER_SEC   (PCLOCK / TICK_PRESC)
                     90: #define        MS_PER_TICK     (1000000 / TICKS_PER_SEC)
                     91:
                     92: int
                     93: tick_init(void)
                     94: {
                     95:
                     96:        _reg_bclr_1(TSTR, TSTR_CH);
                     97:        _reg_write_2(TCR, TCR_TPSC);
                     98:        _reg_write_4(TCOR, 0xffffffff);
                     99:        _reg_write_4(TCNT, 0xffffffff);
                    100:        _reg_bset_1(TSTR, TSTR_CH);
                    101:
                    102:        return 0;
                    103: }
                    104:
                    105: void
                    106: tick_stop(void)
                    107: {
                    108:
                    109:        _reg_bclr_1(TSTR, TSTR_CH);
                    110: }
                    111:
                    112: uint32_t
                    113: gettick(void)
                    114: {
                    115:
                    116:        return ~(_reg_read_4(TCNT));
                    117: }
                    118:
                    119: void
                    120: delay(int ms)
                    121: {
                    122:        uint32_t base, now;
                    123:
                    124:        base = gettick();
                    125:        for (;;) {
                    126:                now = gettick();
                    127:                if (((now - base) / MS_PER_TICK) > ms) {
                    128:                        break;
                    129:                }
                    130:        }
                    131: }