SerialDevice.cpp 4.6 KB

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