123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151 |
- /*
- * Copyright (c) 2018-2020, Andreas Kling <kling@serenityos.org>
- * All rights reserved.
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions are met:
- *
- * 1. Redistributions of source code must retain the above copyright notice, this
- * list of conditions and the following disclaimer.
- *
- * 2. Redistributions in binary form must reproduce the above copyright notice,
- * this list of conditions and the following disclaimer in the documentation
- * and/or other materials provided with the distribution.
- *
- * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
- * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
- * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
- * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
- * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
- * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
- * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
- * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
- * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
- * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- */
- #include <Kernel/Devices/SerialDevice.h>
- #include <Kernel/IO.h>
- namespace Kernel {
- SerialDevice::SerialDevice(int base_addr, unsigned minor)
- : CharacterDevice(4, minor)
- , m_base_addr(base_addr)
- {
- initialize();
- }
- SerialDevice::~SerialDevice()
- {
- }
- bool SerialDevice::can_read(const FileDescription&, size_t) const
- {
- return (get_line_status() & DataReady) != 0;
- }
- KResultOr<size_t> SerialDevice::read(FileDescription&, size_t, UserOrKernelBuffer& buffer, size_t size)
- {
- if (!size)
- return 0;
- if (!(get_line_status() & DataReady))
- return 0;
- ssize_t nwritten = buffer.write_buffered<128>(size, [&](u8* data, size_t data_size) {
- for (size_t i = 0; i < data_size; i++)
- data[i] = IO::in8(m_base_addr);
- return (ssize_t)data_size;
- });
- if (nwritten < 0)
- return KResult(nwritten);
- return size;
- }
- bool SerialDevice::can_write(const FileDescription&, size_t) const
- {
- return (get_line_status() & EmptyTransmitterHoldingRegister) != 0;
- }
- KResultOr<size_t> SerialDevice::write(FileDescription&, size_t, const UserOrKernelBuffer& buffer, size_t size)
- {
- if (!size)
- return 0;
- if (!(get_line_status() & EmptyTransmitterHoldingRegister))
- return 0;
- ssize_t nread = buffer.read_buffered<128>(size, [&](const u8* data, size_t data_size) {
- for (size_t i = 0; i < data_size; i++)
- IO::out8(m_base_addr, data[i]);
- return (ssize_t)data_size;
- });
- if (nread < 0)
- return KResult(nread);
- return (size_t)nread;
- }
- void SerialDevice::initialize()
- {
- set_interrupts(0);
- set_baud(Baud38400);
- set_line_control(None, One, EightBits);
- set_fifo_control(EnableFIFO | ClearReceiveFIFO | ClearTransmitFIFO | TriggerLevel4);
- set_modem_control(RequestToSend | DataTerminalReady);
- }
- void SerialDevice::set_interrupts(char interrupt_enable)
- {
- m_interrupt_enable = interrupt_enable;
- IO::out8(m_base_addr + 1, interrupt_enable);
- }
- void SerialDevice::set_baud(Baud baud)
- {
- m_baud = baud;
- IO::out8(m_base_addr + 3, IO::in8(m_base_addr + 3) | 0x80); // turn on DLAB
- IO::out8(m_base_addr + 0, ((char)(baud)) >> 2); // lower half of divisor
- IO::out8(m_base_addr + 1, ((char)(baud)) & 0xff); // upper half of divisor
- IO::out8(m_base_addr + 3, IO::in8(m_base_addr + 3) & 0x7f); // turn off DLAB
- }
- void SerialDevice::set_fifo_control(char fifo_control)
- {
- m_fifo_control = fifo_control;
- IO::out8(m_base_addr + 2, fifo_control);
- }
- void SerialDevice::set_line_control(ParitySelect parity_select, StopBits stop_bits, WordLength word_length)
- {
- m_parity_select = parity_select;
- m_stop_bits = stop_bits;
- m_word_length = word_length;
- IO::out8(m_base_addr + 3, IO::in8(m_base_addr + 3) & (0xc0 | parity_select | stop_bits | word_length));
- }
- void SerialDevice::set_break_enable(bool break_enable)
- {
- m_break_enable = break_enable;
- IO::out8(m_base_addr + 3, IO::in8(m_base_addr + 3) & (break_enable ? 0xff : 0xbf));
- }
- void SerialDevice::set_modem_control(char modem_control)
- {
- m_modem_control = modem_control;
- IO::out8(m_base_addr + 4, modem_control);
- }
- char SerialDevice::get_line_status() const
- {
- return IO::in8(m_base_addr + 5);
- }
- }
|