summaryrefslogtreecommitdiffstats
path: root/qemu/roms/SLOF/board-js2x/slof/freq.fs
blob: 9f1d36d7869bcabe3005f94274d1ac76a1fbc75e (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
\ *****************************************************************************
\ * Copyright (c) 2004, 2008 IBM Corporation
\ * All rights reserved.
\ * This program and the accompanying materials
\ * are made available under the terms of the BSD License
\ * which accompanies this distribution, and is available at
\ * http://www.opensource.org/licenses/bsd-license.php
\ *
\ * Contributors:
\ *     IBM Corporation - initial implementation
\ ****************************************************************************/


\ Use the HPET to calculate various frequencies.

\ Make HPET run.
1 10 hpet!

\ Set PMC1 to count CPU cycles.
f00 mmcr0!

d# 1000000000000000 4 hpet@ / CONSTANT hpet-freq

: get-times  tbl@ pmc1@ f0 hpet@ ;

\ Calculate the CPU and TB frequencies.
: calibrate  get-times dup >r swap >r swap >r hpet-freq d# 100 / + >r
             BEGIN get-times dup r@ < WHILE 3drop REPEAT r> drop
             rot r> - ffffffff and \ TB
             rot r> - ffffffff and \ CPU
             rot r> - >r           \ HPET
             hpet-freq * r@ / swap
             hpet-freq * r> / ;

: round-to  tuck 2/ + over / * ;
calibrate TO tb-frequency d# 100000000 round-to TO cpu-frequency

\ Stop HPET.
0 10 hpet!