From 8acd5d77d677f501996470b190485c580d650a09 Mon Sep 17 00:00:00 2001 From: Franklin Wei Date: Thu, 5 Feb 2015 20:56:26 -0500 Subject: add a new pc speaker driver and a multiboot header --- drivers/include/pcspkr.h | 3 +++ drivers/pcspkr.c | 19 +++++++++++++++++++ 2 files changed, 22 insertions(+) create mode 100644 drivers/include/pcspkr.h create mode 100644 drivers/pcspkr.c (limited to 'drivers') diff --git a/drivers/include/pcspkr.h b/drivers/include/pcspkr.h new file mode 100644 index 0000000..84e640f --- /dev/null +++ b/drivers/include/pcspkr.h @@ -0,0 +1,3 @@ +#include + +void pcspkr_play(uint32_t freq); diff --git a/drivers/pcspkr.c b/drivers/pcspkr.c new file mode 100644 index 0000000..33c0540 --- /dev/null +++ b/drivers/pcspkr.c @@ -0,0 +1,19 @@ +#include +#include "io.h" +#include "pcspkr.h" + +void pcspkr_play(uint32_t freq) +{ + uint32_t div; + uint8_t tmp; + + div = 1193180 / freq; + outb(0x43, 0xb6); + outb(0x42, (uint8_t)(div)); + outb(0x42, (uint8_t)(div >> 8)); + + tmp = inb(0x61); + if (tmp != (tmp | 3)) { + outb(0x61, tmp | 3); + } +} -- cgit v1.1