RTC.cpp 2.3 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/CPU.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. void RealTimeClock::handle_irq(const RegisterState& regs)
  28. {
  29. HardwareTimer::handle_irq(regs);
  30. CMOS::read(0x8C);
  31. }
  32. size_t RealTimeClock::ticks_per_second() const
  33. {
  34. return m_frequency;
  35. }
  36. void RealTimeClock::reset_to_default_ticks_per_second()
  37. {
  38. InterruptDisabler disabler;
  39. bool success = try_to_set_frequency(1024);
  40. VERIFY(success);
  41. }
  42. // FIXME: This is a quick & dirty log base 2 with a parameter. Please provide something better in the future.
  43. static int quick_log2(size_t number)
  44. {
  45. int count = 0;
  46. while (number >>= 1)
  47. count++;
  48. return count;
  49. }
  50. bool RealTimeClock::try_to_set_frequency(size_t frequency)
  51. {
  52. InterruptDisabler disabler;
  53. if (!is_capable_of_frequency(frequency))
  54. return false;
  55. disable_irq();
  56. u8 previous_rate = CMOS::read(0x8A);
  57. u8 rate = quick_log2(32768 / frequency) + 1;
  58. dbgln("RTC: Set rate to {}", rate);
  59. CMOS::write(0x8A, (previous_rate & 0xF0) | rate);
  60. m_frequency = frequency;
  61. dbgln("RTC: Set frequency to {} Hz", frequency);
  62. enable_irq();
  63. return true;
  64. }
  65. bool RealTimeClock::is_capable_of_frequency(size_t frequency) const
  66. {
  67. VERIFY(frequency != 0);
  68. if (frequency > MAX_FREQUENCY)
  69. return false;
  70. if (32768 % frequency)
  71. return false;
  72. u16 divider = 32768 / frequency;
  73. return (divider <= 16384 && divider >= 4); // Frequency can be in range of 2 Hz to 8 KHz
  74. }
  75. size_t RealTimeClock::calculate_nearest_possible_frequency(size_t frequency) const
  76. {
  77. VERIFY(frequency != 0);
  78. return frequency;
  79. }
  80. }