Home | History | Annotate | Line # | Download | only in boot
clock.c revision 1.1.2.2 
      1  1.1.2.2  bouyer /*	$NetBSD: clock.c,v 1.1.2.2 2011/03/05 15:09:54 bouyer Exp $	*/
      2  1.1.2.2  bouyer /*
      3  1.1.2.2  bouyer  * Copyright (c) 2011 KIYOHARA Takashi
      4  1.1.2.2  bouyer  * All rights reserved.
      5  1.1.2.2  bouyer  *
      6  1.1.2.2  bouyer  * Redistribution and use in source and binary forms, with or without
      7  1.1.2.2  bouyer  * modification, are permitted provided that the following conditions
      8  1.1.2.2  bouyer  * are met:
      9  1.1.2.2  bouyer  * 1. Redistributions of source code must retain the above copyright
     10  1.1.2.2  bouyer  *    notice, this list of conditions and the following disclaimer.
     11  1.1.2.2  bouyer  * 2. Redistributions in binary form must reproduce the above copyright
     12  1.1.2.2  bouyer  *    notice, this list of conditions and the following disclaimer in the
     13  1.1.2.2  bouyer  *    documentation and/or other materials provided with the distribution.
     14  1.1.2.2  bouyer  *
     15  1.1.2.2  bouyer  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     16  1.1.2.2  bouyer  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
     17  1.1.2.2  bouyer  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
     18  1.1.2.2  bouyer  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
     19  1.1.2.2  bouyer  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     20  1.1.2.2  bouyer  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     21  1.1.2.2  bouyer  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     22  1.1.2.2  bouyer  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
     23  1.1.2.2  bouyer  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
     24  1.1.2.2  bouyer  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     25  1.1.2.2  bouyer  * POSSIBILITY OF SUCH DAMAGE.
     26  1.1.2.2  bouyer  */
     27  1.1.2.2  bouyer 
     28  1.1.2.2  bouyer #include <lib/libsa/stand.h>
     29  1.1.2.2  bouyer 
     30  1.1.2.2  bouyer #include <sh3/devreg.h>
     31  1.1.2.2  bouyer #include <sh3/tmureg.h>
     32  1.1.2.2  bouyer 
     33  1.1.2.2  bouyer #include "boot.h"
     34  1.1.2.2  bouyer 
     35  1.1.2.2  bouyer void
     36  1.1.2.2  bouyer tmu_init(void)
     37  1.1.2.2  bouyer {
     38  1.1.2.2  bouyer 
     39  1.1.2.2  bouyer 	/* Enable TMU channel 0. */
     40  1.1.2.2  bouyer 	_reg_write_1(SH_(TOCR), TOCR_TCOE);
     41  1.1.2.2  bouyer 	_reg_write_2(SH_(TCR0), TCR_TPSC_P4);
     42  1.1.2.2  bouyer 	_reg_bset_1(SH_(TSTR), TSTR_STR0);
     43  1.1.2.2  bouyer }
     44  1.1.2.2  bouyer 
     45  1.1.2.2  bouyer void
     46  1.1.2.2  bouyer delay(int n)
     47  1.1.2.2  bouyer {
     48  1.1.2.2  bouyer 	int t1, t2, x;
     49  1.1.2.2  bouyer 
     50  1.1.2.2  bouyer 	x = n * 11;
     51  1.1.2.2  bouyer 	t1 = _reg_read_4(SH_(TCNT0));
     52  1.1.2.2  bouyer 	while (x > 0) {
     53  1.1.2.2  bouyer 		t2 = _reg_read_4(SH_(TCNT0));
     54  1.1.2.2  bouyer 		if (t2 > t1)
     55  1.1.2.2  bouyer 			x -= (t2 - t1 - 1);
     56  1.1.2.2  bouyer 		else
     57  1.1.2.2  bouyer 			x -= (t1 - t2);
     58  1.1.2.2  bouyer 		t1 = t2;
     59  1.1.2.2  bouyer 	}
     60  1.1.2.2  bouyer }
     61