PCSpeaker.cpp 575 B

12345678910111213141516171819202122232425
  1. /*
  2. * Copyright (c) 2018-2020, Andreas Kling <kling@serenityos.org>
  3. *
  4. * SPDX-License-Identifier: BSD-2-Clause
  5. */
  6. #include <Kernel/Devices/PCSpeaker.h>
  7. #include <Kernel/IO.h>
  8. #include <Kernel/Time/PIT.h>
  9. void PCSpeaker::tone_on(int frequency)
  10. {
  11. IO::out8(PIT_CTL, TIMER2_SELECT | WRITE_WORD | MODE_SQUARE_WAVE);
  12. u16 timer_reload = BASE_FREQUENCY / frequency;
  13. IO::out8(TIMER2_CTL, LSB(timer_reload));
  14. IO::out8(TIMER2_CTL, MSB(timer_reload));
  15. IO::out8(0x61, IO::in8(0x61) | 3);
  16. }
  17. void PCSpeaker::tone_off()
  18. {
  19. IO::out8(0x61, IO::in8(0x61) & ~3);
  20. }