arch/x86/lib/i8254.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * (C) Copyright 2002
   4  * Daniel Engström, Omicron Ceti AB, <daniel@omicron.se>
   5  */
   6
   7 #include <common.h>
   8 #include <asm/io.h>
   9 #include <asm/i8254.h>
  10
  11 #define TIMER1_VALUE            18      /* 15.6us */
  12 #define BEEP_FREQUENCY_HZ       440
  13 #define SYSCTL_PORTB            0x61
  14 #define PORTB_BEEP_ENABLE       0x3
  15
  16 static void i8254_set_beep_freq(uint frequency_hz)
  17 {
  18         uint countdown;
  19
  20         countdown = PIT_TICK_RATE / frequency_hz;
  21
  22         outb(countdown & 0xff, PIT_BASE + PIT_T2);
  23         outb((countdown >> 8) & 0xff, PIT_BASE + PIT_T2);
  24 }
  25
  26 int i8254_init(void)
  27 {
  28         /*
  29          * Initialize counter 1, used to refresh request signal.
  30          * This is required for legacy purpose as some codes like
  31          * vgabios utilizes counter 1 to provide delay functionality.
  32          */
  33         outb(PIT_CMD_CTR1 | PIT_CMD_LOW | PIT_CMD_MODE2,
  34              PIT_BASE + PIT_COMMAND);
  35         outb(TIMER1_VALUE, PIT_BASE + PIT_T1);
  36
  37         /*
  38          * Initialize counter 2, used to drive the speaker.
  39          * To start a beep, set both bit0 and bit1 of port 0x61.
  40          * To stop it, clear both bit0 and bit1 of port 0x61.
  41          */
  42         outb(PIT_CMD_CTR2 | PIT_CMD_BOTH | PIT_CMD_MODE3,
  43              PIT_BASE + PIT_COMMAND);
  44         i8254_set_beep_freq(BEEP_FREQUENCY_HZ);
  45
  46         return 0;
  47 }
  48
  49 int i8254_enable_beep(uint frequency_hz)
  50 {
  51         if (!frequency_hz)
  52                 return -EINVAL;
  53
  54         i8254_set_beep_freq(frequency_hz);
  55         setio_8(SYSCTL_PORTB, PORTB_BEEP_ENABLE);
  56
  57         return 0;
  58 }
  59
  60 void i8254_disable_beep(void)
  61 {
  62         clrio_8(SYSCTL_PORTB, PORTB_BEEP_ENABLE);
  63 }