mirror of
https://github.com/u-boot/u-boot.git
synced 2025-04-24 14:25:56 +00:00
d678a59d2d
When bringing in the series 'arm: dts: am62-beagleplay: Fix Beagleplay Ethernet"' I failed to notice that b4 noticed it was based on next and so took that as the base commit and merged that part of next to master. This reverts commitc8ffd1356d, reversing changes made to2ee6f3a5f7. Reported-by: Jonas Karlman <jonas@kwiboo.se> Signed-off-by: Tom Rini <trini@konsulko.com>
68 lines
1.6 KiB
C
68 lines
1.6 KiB
C
// 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);
|
|
}
|