SerialDevice.cpp 3.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145
  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/SerialDevice.h>
  8. #include <Kernel/IO.h>
  9. namespace Kernel {
  10. UNMAP_AFTER_INIT SerialDevice::SerialDevice(IOAddress base_addr, unsigned minor)
  11. : CharacterDevice(4, minor)
  12. , m_base_addr(base_addr)
  13. {
  14. initialize();
  15. }
  16. UNMAP_AFTER_INIT SerialDevice::~SerialDevice()
  17. {
  18. }
  19. bool SerialDevice::can_read(const FileDescription&, size_t) const
  20. {
  21. return (get_line_status() & DataReady) != 0;
  22. }
  23. KResultOr<size_t> SerialDevice::read(FileDescription&, u64, UserOrKernelBuffer& buffer, size_t size)
  24. {
  25. if (!size)
  26. return 0;
  27. ScopedSpinLock lock(m_serial_lock);
  28. if (!(get_line_status() & DataReady))
  29. return 0;
  30. return buffer.write_buffered<128>(size, [&](u8* data, size_t data_size) {
  31. for (size_t i = 0; i < data_size; i++)
  32. data[i] = m_base_addr.in<u8>();
  33. return data_size;
  34. });
  35. }
  36. bool SerialDevice::can_write(const FileDescription&, size_t) const
  37. {
  38. return (get_line_status() & EmptyTransmitterHoldingRegister) != 0;
  39. }
  40. KResultOr<size_t> SerialDevice::write(FileDescription& description, u64, const UserOrKernelBuffer& buffer, size_t size)
  41. {
  42. if (!size)
  43. return 0;
  44. ScopedSpinLock lock(m_serial_lock);
  45. if (!can_write(description, size))
  46. return EAGAIN;
  47. return buffer.read_buffered<128>(size, [&](u8 const* data, size_t data_size) {
  48. for (size_t i = 0; i < data_size; i++)
  49. put_char(data[i]);
  50. return data_size;
  51. });
  52. }
  53. void SerialDevice::put_char(char ch)
  54. {
  55. while ((get_line_status() & EmptyTransmitterHoldingRegister) == 0)
  56. ;
  57. if (ch == '\n' && !m_last_put_char_was_carriage_return)
  58. m_base_addr.out<u8>('\r');
  59. m_base_addr.out<u8>(ch);
  60. m_last_put_char_was_carriage_return = (ch == '\r');
  61. }
  62. String SerialDevice::device_name() const
  63. {
  64. return String::formatted("ttyS{}", minor() - 64);
  65. }
  66. UNMAP_AFTER_INIT void SerialDevice::initialize()
  67. {
  68. set_interrupts(false);
  69. set_baud(Baud38400);
  70. set_line_control(None, One, EightBits);
  71. set_fifo_control(EnableFIFO | ClearReceiveFIFO | ClearTransmitFIFO | TriggerLevel4);
  72. set_modem_control(RequestToSend | DataTerminalReady);
  73. }
  74. UNMAP_AFTER_INIT void SerialDevice::set_interrupts(bool interrupt_enable)
  75. {
  76. m_interrupt_enable = interrupt_enable;
  77. m_base_addr.offset(1).out<u8>(interrupt_enable);
  78. }
  79. void SerialDevice::set_baud(Baud baud)
  80. {
  81. m_baud = baud;
  82. m_base_addr.offset(3).out<u8>(m_base_addr.offset(3).in<u8>() | 0x80); // turn on DLAB
  83. m_base_addr.out<u8>(((u8)(baud)) & 0xff); // lower half of divisor
  84. m_base_addr.offset(1).out<u8>(((u8)(baud)) >> 2); // upper half of divisor
  85. m_base_addr.offset(3).out<u8>(m_base_addr.offset(3).in<u8>() & 0x7f); // turn off DLAB
  86. }
  87. void SerialDevice::set_fifo_control(u8 fifo_control)
  88. {
  89. m_fifo_control = fifo_control;
  90. m_base_addr.offset(2).out<u8>(fifo_control);
  91. }
  92. void SerialDevice::set_line_control(ParitySelect parity_select, StopBits stop_bits, WordLength word_length)
  93. {
  94. m_parity_select = parity_select;
  95. m_stop_bits = stop_bits;
  96. m_word_length = word_length;
  97. m_base_addr.offset(3).out<u8>((m_base_addr.offset(3).in<u8>() & ~0x3f) | parity_select | stop_bits | word_length);
  98. }
  99. void SerialDevice::set_break_enable(bool break_enable)
  100. {
  101. m_break_enable = break_enable;
  102. m_base_addr.offset(3).out<u8>(m_base_addr.offset(3).in<u8>() & (break_enable ? 0xff : 0xbf));
  103. }
  104. void SerialDevice::set_modem_control(u8 modem_control)
  105. {
  106. m_modem_control = modem_control;
  107. m_base_addr.offset(4).out<u8>(modem_control);
  108. }
  109. u8 SerialDevice::get_line_status() const
  110. {
  111. return m_base_addr.offset(5).in<u8>();
  112. }
  113. }