PIT.cpp 2.2 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889
  1. /*
  2. * Copyright (c) 2020, Liav A. <liavalb@hotmail.co.il>
  3. *
  4. * SPDX-License-Identifier: BSD-2-Clause
  5. */
  6. #include <Kernel/Arch/x86/InterruptDisabler.h>
  7. #include <Kernel/IO.h>
  8. #include <Kernel/Interrupts/GenericInterruptHandler.h>
  9. #include <Kernel/Scheduler.h>
  10. #include <Kernel/Sections.h>
  11. #include <Kernel/Thread.h>
  12. #include <Kernel/Time/PIT.h>
  13. #include <Kernel/Time/TimeManagement.h>
  14. #define IRQ_TIMER 0
  15. namespace Kernel {
  16. UNMAP_AFTER_INIT NonnullRefPtr<PIT> PIT::initialize(Function<void(const RegisterState&)> callback)
  17. {
  18. return adopt_ref(*new PIT(move(callback)));
  19. }
  20. [[maybe_unused]] inline static void reset_countdown(u16 timer_reload)
  21. {
  22. IO::out8(PIT_CTL, TIMER0_SELECT | WRITE_WORD | MODE_COUNTDOWN);
  23. IO::out8(TIMER0_CTL, LSB(timer_reload));
  24. IO::out8(TIMER0_CTL, MSB(timer_reload));
  25. }
  26. PIT::PIT(Function<void(const RegisterState&)> callback)
  27. : HardwareTimer(IRQ_TIMER, move(callback))
  28. , m_periodic(true)
  29. {
  30. IO::out8(PIT_CTL, TIMER0_SELECT | WRITE_WORD | MODE_SQUARE_WAVE);
  31. dmesgln("PIT: {} Hz, square wave ({:#08x})", OPTIMAL_TICKS_PER_SECOND_RATE, BASE_FREQUENCY / OPTIMAL_TICKS_PER_SECOND_RATE);
  32. reset_to_default_ticks_per_second();
  33. enable_irq();
  34. }
  35. size_t PIT::ticks_per_second() const
  36. {
  37. return m_frequency;
  38. }
  39. void PIT::set_periodic()
  40. {
  41. // FIXME: Implement it...
  42. VERIFY_NOT_REACHED();
  43. }
  44. void PIT::set_non_periodic()
  45. {
  46. // FIXME: Implement it...
  47. VERIFY_NOT_REACHED();
  48. }
  49. void PIT::reset_to_default_ticks_per_second()
  50. {
  51. InterruptDisabler disabler;
  52. bool success = try_to_set_frequency(OPTIMAL_TICKS_PER_SECOND_RATE);
  53. VERIFY(success);
  54. }
  55. bool PIT::try_to_set_frequency(size_t frequency)
  56. {
  57. InterruptDisabler disabler;
  58. if (!is_capable_of_frequency(frequency))
  59. return false;
  60. disable_irq();
  61. size_t reload_value = BASE_FREQUENCY / frequency;
  62. IO::out8(TIMER0_CTL, LSB(reload_value));
  63. IO::out8(TIMER0_CTL, MSB(reload_value));
  64. m_frequency = frequency;
  65. enable_irq();
  66. return true;
  67. }
  68. bool PIT::is_capable_of_frequency(size_t frequency) const
  69. {
  70. VERIFY(frequency != 0);
  71. return frequency <= BASE_FREQUENCY;
  72. }
  73. size_t PIT::calculate_nearest_possible_frequency(size_t frequency) const
  74. {
  75. VERIFY(frequency != 0);
  76. return frequency;
  77. }
  78. }