payloads/libpayload/arch/i386/timer.c

   1 /*
   2  * This file is part of the libpayload project.
   3  *
   4  * Copyright (C) 2008 Advanced Micro Devices, Inc.
   5  *
   6  * Redistribution and use in source and binary forms, with or without
   7  * modification, are permitted provided that the following conditions
   8  * are met:
   9  * 1. Redistributions of source code must retain the above copyright
  10  *    notice, this list of conditions and the following disclaimer.
  11  * 2. Redistributions in binary form must reproduce the above copyright
  12  *    notice, this list of conditions and the following disclaimer in the
  13  *    documentation and/or other materials provided with the distribution.
  14  * 3. The name of the author may not be used to endorse or promote products
  15  *    derived from this software without specific prior written permission.
  16  *
  17  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR 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 AUTHOR 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 /**
  31  * @file i386/timer.c
  32  * i386 specific timer routines
  33  */
  34
  35 #include <libpayload.h>
  36 #include <arch/rdtsc.h>
  37
  38 /**
  39  * @ingroup arch
  40  * Global variable containing the speed of the processor in KHz.
  41  */
  42 u32 cpu_khz;
  43
  44 /**
  45  * Calculate the speed of the processor for use in delays.
  46  *
  47  * @return The CPU speed in kHz.
  48  */
  49 unsigned int get_cpu_speed(void)
  50 {
  51         unsigned long long start, end;
  52
  53         /* Set up the PPC port - disable the speaker, enable the T2 gate. */
  54         outb((inb(0x61) & ~0x02) | 0x01, 0x61);
  55
  56         /* Set the PIT to Mode 0, counter 2, word access. */
  57         outb(0xB0, 0x43);
  58
  59         /* Load the counter with 0xffff. */
  60         outb(0xff, 0x42);
  61         outb(0xff, 0x42);
  62
  63         /* Read the number of ticks during the period. */
  64         start = rdtsc();
  65         while (!(inb(0x61) & 0x20)) ;
  66         end = rdtsc();
  67
  68         /*
  69          * The clock rate is 1193180 Hz, the number of milliseconds for a
  70          * period of 0xffff is 1193180 / (0xFFFF * 1000) or .0182.
  71          * Multiply that by the number of measured clocks to get the kHz value.
  72          */
  73         cpu_khz = (unsigned int)((end - start) * 1193180U / (1000 * 0xffff));
  74
  75         return cpu_khz;
  76 }
  77
  78 static inline void _delay(unsigned long long delta)
  79 {
  80         unsigned long long timeout = rdtsc() + delta;
  81         while (rdtsc() < timeout) ;
  82 }
  83
  84 /**
  85  * Delay for a specified number of nanoseconds.
  86  *
  87  * @param n Number of nanoseconds to delay for.
  88  */
  89 void ndelay(unsigned int n)
  90 {
  91         _delay((unsigned long long)n * cpu_khz / 1000000);
  92 }
  93
  94 /**
  95  * Delay for a specified number of microseconds.
  96  *
  97  * @param n Number of microseconds to delay for.
  98  */
  99 void udelay(unsigned int n)
 100 {
 101         _delay((unsigned long long)n * cpu_khz / 1000);
 102 }
 103
 104 /**
 105  * Delay for a specified number of milliseconds.
 106  *
 107  * @param m Number of milliseconds to delay for.
 108  */
 109 void mdelay(unsigned int m)
 110 {
 111         _delay((unsigned long long)m * cpu_khz);
 112 }
 113
 114 /**
 115  * Delay for a specified number of seconds.
 116  *
 117  * @param s Number of seconds to delay for.
 118  */
 119 void delay(unsigned int s)
 120 {
 121         int i;
 122         for (i=0; i<1000; i++)
 123                 _delay((unsigned long long)s * cpu_khz);
 124 }