SerialDevice.cpp 3.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130
  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(u32 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. if (!(get_line_status() & DataReady))
  28. return 0;
  29. return buffer.write_buffered<128>(size, [&](u8* data, size_t data_size) {
  30. for (size_t i = 0; i < data_size; i++)
  31. data[i] = IO::in8(m_base_addr);
  32. return data_size;
  33. });
  34. }
  35. bool SerialDevice::can_write(const FileDescription&, size_t) const
  36. {
  37. return (get_line_status() & EmptyTransmitterHoldingRegister) != 0;
  38. }
  39. KResultOr<size_t> SerialDevice::write(FileDescription&, u64, const UserOrKernelBuffer& buffer, size_t size)
  40. {
  41. if (!size)
  42. return 0;
  43. if (!(get_line_status() & EmptyTransmitterHoldingRegister))
  44. return 0;
  45. return buffer.read_buffered<128>(size, [&](u8 const* data, size_t data_size) {
  46. for (size_t i = 0; i < data_size; i++)
  47. IO::out8(m_base_addr, data[i]);
  48. return data_size;
  49. });
  50. }
  51. String SerialDevice::device_name() const
  52. {
  53. return String::formatted("ttyS{}", minor() - 64);
  54. }
  55. UNMAP_AFTER_INIT void SerialDevice::initialize()
  56. {
  57. set_interrupts(false);
  58. set_baud(Baud38400);
  59. set_line_control(None, One, EightBits);
  60. set_fifo_control(EnableFIFO | ClearReceiveFIFO | ClearTransmitFIFO | TriggerLevel4);
  61. set_modem_control(RequestToSend | DataTerminalReady);
  62. }
  63. UNMAP_AFTER_INIT void SerialDevice::set_interrupts(bool interrupt_enable)
  64. {
  65. m_interrupt_enable = interrupt_enable;
  66. IO::out8(m_base_addr + 1, interrupt_enable);
  67. }
  68. void SerialDevice::set_baud(Baud baud)
  69. {
  70. m_baud = baud;
  71. IO::out8(m_base_addr + 3, IO::in8(m_base_addr + 3) | 0x80); // turn on DLAB
  72. IO::out8(m_base_addr + 0, ((u8)(baud)) >> 2); // lower half of divisor
  73. IO::out8(m_base_addr + 1, ((u8)(baud)) & 0xff); // upper half of divisor
  74. IO::out8(m_base_addr + 3, IO::in8(m_base_addr + 3) & 0x7f); // turn off DLAB
  75. }
  76. void SerialDevice::set_fifo_control(u8 fifo_control)
  77. {
  78. m_fifo_control = fifo_control;
  79. IO::out8(m_base_addr + 2, fifo_control);
  80. }
  81. void SerialDevice::set_line_control(ParitySelect parity_select, StopBits stop_bits, WordLength word_length)
  82. {
  83. m_parity_select = parity_select;
  84. m_stop_bits = stop_bits;
  85. m_word_length = word_length;
  86. IO::out8(m_base_addr + 3, IO::in8(m_base_addr + 3) & (0xc0 | parity_select | stop_bits | word_length));
  87. }
  88. void SerialDevice::set_break_enable(bool break_enable)
  89. {
  90. m_break_enable = break_enable;
  91. IO::out8(m_base_addr + 3, IO::in8(m_base_addr + 3) & (break_enable ? 0xff : 0xbf));
  92. }
  93. void SerialDevice::set_modem_control(u8 modem_control)
  94. {
  95. m_modem_control = modem_control;
  96. IO::out8(m_base_addr + 4, modem_control);
  97. }
  98. u8 SerialDevice::get_line_status() const
  99. {
  100. return IO::in8(m_base_addr + 5);
  101. }
  102. }