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