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 <asm/io.h>
   8 #include <asm/i8254.h>
   9 #include <asm/ibmpc.h>
  10 #include <linux/errno.h>
  11
  12 #define TIMER1_VALUE            18      /* 15.6us */
  13 #define BEEP_FREQUENCY_HZ       440
  14 #define SYSCTL_PORTB            0x61
  15 #define PORTB_BEEP_ENABLE       0x3
  16
  17 static void i8254_set_beep_freq(uint frequency_hz)
  18 {
  19         uint countdown;
  20
  21         countdown = PIT_TICK_RATE / frequency_hz;
  22
  23         outb(countdown & 0xff, PIT_BASE + PIT_T2);
  24         outb((countdown >> 8) & 0xff, PIT_BASE + PIT_T2);
  25 }
  26
  27 int i8254_init(void)
  28 {
  29         /*
  30          * Initialize counter 1, used to refresh request signal.
  31          * This is required for legacy purpose as some codes like
  32          * vgabios utilizes counter 1 to provide delay functionality.
  33          */
  34         outb(PIT_CMD_CTR1 | PIT_CMD_LOW | PIT_CMD_MODE2,
  35              PIT_BASE + PIT_COMMAND);
  36         outb(TIMER1_VALUE, PIT_BASE + PIT_T1);
  37
  38         /*
  39          * Initialize counter 2, used to drive the speaker.
  40          * To start a beep, set both bit0 and bit1 of port 0x61.
  41          * To stop it, clear both bit0 and bit1 of port 0x61.
  42          */
  43         outb(PIT_CMD_CTR2 | PIT_CMD_BOTH | PIT_CMD_MODE3,
  44              PIT_BASE + PIT_COMMAND);
  45         i8254_set_beep_freq(BEEP_FREQUENCY_HZ);
  46
  47         return 0;
  48 }
  49
  50 int i8254_enable_beep(uint frequency_hz)
  51 {
  52         if (!frequency_hz)
  53                 return -EINVAL;
  54
  55         /* make sure i8254 is setup correctly before generating beeps */
  56         outb(PIT_CMD_CTR2 | PIT_CMD_BOTH | PIT_CMD_MODE3,
  57              PIT_BASE + PIT_COMMAND);
  58
  59         i8254_set_beep_freq(frequency_hz);
  60         setio_8(SYSCTL_PORTB, PORTB_BEEP_ENABLE);
  61
  62         return 0;
  63 }
  64
  65 void i8254_disable_beep(void)
  66 {
  67         clrio_8(SYSCTL_PORTB, PORTB_BEEP_ENABLE);
  68 }