RTC.cpp 2.4 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091
  1. /*
  2. * Copyright (c) 2020, Liav A. <liavalb@hotmail.co.il>
  3. *
  4. * SPDX-License-Identifier: BSD-2-Clause
  5. */
  6. #include <Kernel/Arch/InterruptDisabler.h>
  7. #include <Kernel/Arch/x86/IO.h>
  8. #include <Kernel/Arch/x86/NonMaskableInterruptDisabler.h>
  9. #include <Kernel/CMOS.h>
  10. #include <Kernel/Time/RTC.h>
  11. #include <Kernel/Time/TimeManagement.h>
  12. namespace Kernel {
  13. #define IRQ_TIMER 8
  14. #define MAX_FREQUENCY 8000
  15. NonnullRefPtr<RealTimeClock> RealTimeClock::create(Function<void(RegisterState const&)> callback)
  16. {
  17. return adopt_ref(*new RealTimeClock(move(callback)));
  18. }
  19. RealTimeClock::RealTimeClock(Function<void(RegisterState const&)> callback)
  20. : HardwareTimer(IRQ_TIMER, move(callback))
  21. {
  22. InterruptDisabler disabler;
  23. NonMaskableInterruptDisabler nmi_disabler;
  24. enable_irq();
  25. CMOS::write(0x8B, CMOS::read(0xB) | 0x40);
  26. reset_to_default_ticks_per_second();
  27. }
  28. bool RealTimeClock::handle_irq(RegisterState const& regs)
  29. {
  30. auto result = HardwareTimer::handle_irq(regs);
  31. CMOS::read(0x8C);
  32. return result;
  33. }
  34. size_t RealTimeClock::ticks_per_second() const
  35. {
  36. return m_frequency;
  37. }
  38. void RealTimeClock::reset_to_default_ticks_per_second()
  39. {
  40. InterruptDisabler disabler;
  41. bool success = try_to_set_frequency(1024);
  42. VERIFY(success);
  43. }
  44. // FIXME: This is a quick & dirty log base 2 with a parameter. Please provide something better in the future.
  45. static int quick_log2(size_t number)
  46. {
  47. int count = 0;
  48. while (number >>= 1)
  49. count++;
  50. return count;
  51. }
  52. bool RealTimeClock::try_to_set_frequency(size_t frequency)
  53. {
  54. InterruptDisabler disabler;
  55. if (!is_capable_of_frequency(frequency))
  56. return false;
  57. disable_irq();
  58. u8 previous_rate = CMOS::read(0x8A);
  59. u8 rate = quick_log2(32768 / frequency) + 1;
  60. dbgln("RTC: Set rate to {}", rate);
  61. CMOS::write(0x8A, (previous_rate & 0xF0) | rate);
  62. m_frequency = frequency;
  63. dbgln("RTC: Set frequency to {} Hz", frequency);
  64. enable_irq();
  65. return true;
  66. }
  67. bool RealTimeClock::is_capable_of_frequency(size_t frequency) const
  68. {
  69. VERIFY(frequency != 0);
  70. if (frequency > MAX_FREQUENCY)
  71. return false;
  72. if (32768 % frequency)
  73. return false;
  74. u16 divider = 32768 / frequency;
  75. return (divider <= 16384 && divider >= 4); // Frequency can be in range of 2 Hz to 8 KHz
  76. }
  77. size_t RealTimeClock::calculate_nearest_possible_frequency(size_t frequency) const
  78. {
  79. VERIFY(frequency != 0);
  80. return frequency;
  81. }
  82. }