SerialDevice.cpp 3.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139
  1. /*
  2. * Copyright (c) 2018-2020, Andreas Kling <kling@serenityos.org>
  3. * Copyright (c) 2021, Idan Horowitz <idan.horowitz@serenityos.org>
  4. *
  5. * SPDX-License-Identifier: BSD-2-Clause
  6. */
  7. #include <Kernel/Devices/DeviceManagement.h>
  8. #include <Kernel/Devices/SerialDevice.h>
  9. #include <Kernel/Library/IOWindow.h>
  10. #include <Kernel/Sections.h>
  11. namespace Kernel {
  12. UNMAP_AFTER_INIT SerialDevice::SerialDevice(NonnullOwnPtr<IOWindow> registers_io_window, unsigned minor)
  13. : CharacterDevice(4, minor)
  14. , m_registers_io_window(move(registers_io_window))
  15. {
  16. initialize();
  17. }
  18. UNMAP_AFTER_INIT SerialDevice::~SerialDevice() = default;
  19. bool SerialDevice::can_read(OpenFileDescription const&, u64) const
  20. {
  21. return (get_line_status() & DataReady) != 0;
  22. }
  23. ErrorOr<size_t> SerialDevice::read(OpenFileDescription&, u64, UserOrKernelBuffer& buffer, size_t size)
  24. {
  25. if (!size)
  26. return 0;
  27. SpinlockLocker lock(m_serial_lock);
  28. if (!(get_line_status() & DataReady))
  29. return 0;
  30. return buffer.write_buffered<128>(size, [&](Bytes bytes) {
  31. for (auto& byte : bytes)
  32. byte = m_registers_io_window->read8(0);
  33. return bytes.size();
  34. });
  35. }
  36. bool SerialDevice::can_write(OpenFileDescription const&, u64) const
  37. {
  38. return (get_line_status() & EmptyTransmitterHoldingRegister) != 0;
  39. }
  40. ErrorOr<size_t> SerialDevice::write(OpenFileDescription& description, u64, UserOrKernelBuffer const& buffer, size_t size)
  41. {
  42. if (!size)
  43. return 0;
  44. SpinlockLocker lock(m_serial_lock);
  45. if (!can_write(description, size))
  46. return EAGAIN;
  47. return buffer.read_buffered<128>(size, [&](ReadonlyBytes bytes) {
  48. for (auto const& byte : bytes)
  49. put_char(byte);
  50. return bytes.size();
  51. });
  52. }
  53. void SerialDevice::put_char(char ch)
  54. {
  55. while ((get_line_status() & EmptyTransmitterHoldingRegister) == 0)
  56. Processor::wait_check();
  57. if (ch == '\n' && !m_last_put_char_was_carriage_return)
  58. m_registers_io_window->write8(0, '\r');
  59. m_registers_io_window->write8(0, ch);
  60. m_last_put_char_was_carriage_return = (ch == '\r');
  61. }
  62. UNMAP_AFTER_INIT void SerialDevice::initialize()
  63. {
  64. set_interrupts(false);
  65. set_baud(Baud38400);
  66. set_line_control(None, One, EightBits);
  67. set_fifo_control(EnableFIFO | ClearReceiveFIFO | ClearTransmitFIFO | TriggerLevel4);
  68. set_modem_control(RequestToSend | DataTerminalReady);
  69. }
  70. UNMAP_AFTER_INIT void SerialDevice::set_interrupts(bool interrupt_enable)
  71. {
  72. m_interrupt_enable = interrupt_enable;
  73. m_registers_io_window->write8(1, interrupt_enable);
  74. }
  75. void SerialDevice::set_baud(Baud baud)
  76. {
  77. m_baud = baud;
  78. m_registers_io_window->write8(3, m_registers_io_window->read8(3) | 0x80); // turn on DLAB
  79. m_registers_io_window->write8(0, ((u8)(baud)) & 0xff); // lower half of divisor
  80. m_registers_io_window->write8(1, ((u8)(baud)) >> 2); // lower half of divisor
  81. m_registers_io_window->write8(3, m_registers_io_window->read8(3) & 0x7f); // turn off DLAB
  82. }
  83. void SerialDevice::set_fifo_control(u8 fifo_control)
  84. {
  85. m_fifo_control = fifo_control;
  86. m_registers_io_window->write8(2, fifo_control);
  87. }
  88. void SerialDevice::set_line_control(ParitySelect parity_select, StopBits stop_bits, WordLength word_length)
  89. {
  90. m_parity_select = parity_select;
  91. m_stop_bits = stop_bits;
  92. m_word_length = word_length;
  93. m_registers_io_window->write8(3, (m_registers_io_window->read8(3) & ~0x3f) | parity_select | stop_bits | word_length);
  94. }
  95. void SerialDevice::set_break_enable(bool break_enable)
  96. {
  97. m_break_enable = break_enable;
  98. m_registers_io_window->write8(3, m_registers_io_window->read8(3) & (break_enable ? 0xff : 0xbf));
  99. }
  100. void SerialDevice::set_modem_control(u8 modem_control)
  101. {
  102. m_modem_control = modem_control;
  103. m_registers_io_window->write8(4, modem_control);
  104. }
  105. u8 SerialDevice::get_line_status() const
  106. {
  107. return m_registers_io_window->read8(5);
  108. }
  109. }