Aren/toaruos
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

pcspkr: accept -1 and 0 as special lengths

Browse Source
This commit is contained in:
K. Lange 2018-11-29 20:55:30 +09:00
parent 4788ff3cc8
commit 931d3d3b13
1 changed files with 16 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

23
modules/pcspkr.c
View File

@ -9,9 +9,16 @@
static void note(int length, int freq) {
uint32_t div = 11931800 / freq;
uint8_t t;
if (length == 0) {
t = inportb(0x61) & 0xFC;
outportb(0x61, t);
return;
}
uint32_t div = 11931800 / freq;
outportb(0x43, 0xb6);
outportb(0x42, (uint8_t)(div));
outportb(0x42, (uint8_t)(div >> 8));
@ -19,13 +26,15 @@ static void note(int length, int freq) {
t = inportb(0x61);
outportb(0x61, t | 0x3);
unsigned long s, ss;
relative_time(length / 1000, length % 1000, &s, &ss);
sleep_until((process_t *)current_process, s, ss);
switch_task(0);
if (length > 0) {
unsigned long s, ss;
relative_time(length / 1000, length % 1000, &s, &ss);
sleep_until((process_t *)current_process, s, ss);
switch_task(0);
t = inportb(0x61) & 0xFC;
outportb(0x61, t);
t = inportb(0x61) & 0xFC;
outportb(0x61, t);
}
}