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
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
|
// SPDX-License-Identifier: GPL-2.0+
/*
* (C) Copyright 2002
* Daniel Engström, Omicron Ceti AB, <daniel@omicron.se>
*/
#include <common.h>
#include <asm/io.h>
#include <asm/i8254.h>
#include <asm/ibmpc.h>
#define TIMER1_VALUE 18 /* 15.6us */
#define BEEP_FREQUENCY_HZ 440
#define SYSCTL_PORTB 0x61
#define PORTB_BEEP_ENABLE 0x3
static void i8254_set_beep_freq(uint frequency_hz)
{
uint countdown;
countdown = PIT_TICK_RATE / frequency_hz;
outb(countdown & 0xff, PIT_BASE + PIT_T2);
outb((countdown >> 8) & 0xff, PIT_BASE + PIT_T2);
}
int i8254_init(void)
{
/*
* Initialize counter 1, used to refresh request signal.
* This is required for legacy purpose as some codes like
* vgabios utilizes counter 1 to provide delay functionality.
*/
outb(PIT_CMD_CTR1 | PIT_CMD_LOW | PIT_CMD_MODE2,
PIT_BASE + PIT_COMMAND);
outb(TIMER1_VALUE, PIT_BASE + PIT_T1);
/*
* Initialize counter 2, used to drive the speaker.
* To start a beep, set both bit0 and bit1 of port 0x61.
* To stop it, clear both bit0 and bit1 of port 0x61.
*/
outb(PIT_CMD_CTR2 | PIT_CMD_BOTH | PIT_CMD_MODE3,
PIT_BASE + PIT_COMMAND);
i8254_set_beep_freq(BEEP_FREQUENCY_HZ);
return 0;
}
int i8254_enable_beep(uint frequency_hz)
{
if (!frequency_hz)
return -EINVAL;
/* make sure i8254 is setup correctly before generating beeps */
outb(PIT_CMD_CTR2 | PIT_CMD_BOTH | PIT_CMD_MODE3,
PIT_BASE + PIT_COMMAND);
i8254_set_beep_freq(frequency_hz);
setio_8(SYSCTL_PORTB, PORTB_BEEP_ENABLE);
return 0;
}
void i8254_disable_beep(void)
{
clrio_8(SYSCTL_PORTB, PORTB_BEEP_ENABLE);
}
|