|
@@ -0,0 +1,52 @@
|
|
|
+#include <kernel/hw/serial.h>
|
|
|
+#include <asm/port_io.h>
|
|
|
+
|
|
|
+int32_t init_serial_port(port_id_t port)
|
|
|
+{
|
|
|
+ // taken from osdev.org
|
|
|
+
|
|
|
+ asm_outb(port + 1, 0x00); // Disable all interrupts
|
|
|
+ asm_outb(port + 3, 0x80); // Enable DLAB (set baud rate divisor)
|
|
|
+ // TODO: set baud rate
|
|
|
+ asm_outb(port + 0, 0x00); // Set divisor to 0 -3- (lo byte) 115200 -38400- baud
|
|
|
+ asm_outb(port + 1, 0x00); // (hi byte)
|
|
|
+ asm_outb(port + 3, 0x03); // 8 bits, no parity, one stop bit
|
|
|
+ asm_outb(port + 2, 0xC7); // Enable FIFO, clear them, with 14-byte threshold
|
|
|
+ asm_outb(port + 4, 0x0B); // IRQs enabled, RTS/DSR set
|
|
|
+ asm_outb(port + 4, 0x1E); // Set in loopback mode, test the serial chip
|
|
|
+ asm_outb(port + 0, 0xAE); // Test serial chip (send byte 0xAE and check if serial returns same byte)
|
|
|
+
|
|
|
+ // Check if serial is faulty (i.e: not same byte as sent)
|
|
|
+ if(asm_inb(port + 0) != 0xAE) {
|
|
|
+ return 1;
|
|
|
+ }
|
|
|
+
|
|
|
+ // If serial is not faulty set it in normal operation mode
|
|
|
+ // (not-loopback with IRQs enabled and OUT#1 and OUT#2 bits enabled)
|
|
|
+ asm_outb(port + 4, 0x0F);
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+int32_t is_serial_has_data(port_id_t port)
|
|
|
+{
|
|
|
+ return asm_inb(port + 5) & 1;
|
|
|
+}
|
|
|
+
|
|
|
+uint8_t serial_read_data(port_id_t port)
|
|
|
+{
|
|
|
+ while (is_serial_has_data(port) == 0)
|
|
|
+ ;
|
|
|
+ return asm_inb(port);
|
|
|
+}
|
|
|
+
|
|
|
+int32_t is_serial_ready_for_transmition(port_id_t port)
|
|
|
+{
|
|
|
+ return asm_inb(port + 5) & 0x20;
|
|
|
+}
|
|
|
+
|
|
|
+void serial_send_data(port_id_t port, uint8_t data)
|
|
|
+{
|
|
|
+ while (is_serial_ready_for_transmition(port) == 0)
|
|
|
+ ;
|
|
|
+ return asm_outb(port, data);
|
|
|
+}
|