PIT.cpp 2.2 KB

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