74 lines
1.6 KiB
C
74 lines
1.6 KiB
C
#include <stdint.h>
|
|
#include <stddef.h>
|
|
#include "proc/proc.h"
|
|
#include "ipc/pipe/pipe.h"
|
|
#include "hal/hal.h"
|
|
#include "dlmalloc/malloc.h"
|
|
|
|
#define SERIAL_PORT 0x3f8
|
|
|
|
Proc *SERIALPROC;
|
|
|
|
void serialproc_init(Proc *proc) {
|
|
SERIALPROC = proc;
|
|
SERIALPROC->pipes[0] = dlmalloc(sizeof(IpcPipe));
|
|
ipc_pipeinit(SERIALPROC->pipes[0]);
|
|
SERIALPROC->pipes[1] = dlmalloc(sizeof(IpcPipe));
|
|
ipc_pipeinit(SERIALPROC->pipes[1]);
|
|
|
|
io_out8(SERIAL_PORT + 1, 0x00);
|
|
io_out8(SERIAL_PORT + 3, 0x80);
|
|
io_out8(SERIAL_PORT + 0, 0x03);
|
|
io_out8(SERIAL_PORT + 1, 0x00);
|
|
io_out8(SERIAL_PORT + 3, 0x03);
|
|
io_out8(SERIAL_PORT + 2, 0xc7);
|
|
io_out8(SERIAL_PORT + 4, 0x0b);
|
|
io_out8(SERIAL_PORT + 4, 0x1e);
|
|
io_out8(SERIAL_PORT + 0, 0xae);
|
|
|
|
if (io_in8(SERIAL_PORT + 0) != 0xae) {
|
|
return;
|
|
}
|
|
|
|
io_out8(SERIAL_PORT + 4, 0x0f);
|
|
}
|
|
|
|
int serialproc_received(void) {
|
|
return io_in8(SERIAL_PORT + 5) & 1;
|
|
}
|
|
|
|
uint8_t serialproc_read(void) {
|
|
while (serialproc_received() == 0);
|
|
return io_in8(SERIAL_PORT);
|
|
}
|
|
|
|
int serialproc_trans_empty(void) {
|
|
return io_in8(SERIAL_PORT + 5) & 0x20;
|
|
}
|
|
|
|
void serialproc_write(uint8_t value) {
|
|
while (!serialproc_trans_empty());
|
|
io_out8(SERIAL_PORT, value);
|
|
}
|
|
|
|
void serialproc_fn(void) {
|
|
char buf[0x100];
|
|
for (;;) {
|
|
|
|
hal_memset(buf, 0, sizeof(buf));
|
|
int32_t read = ipc_piperead(SERIALPROC->pipes[1], (uint8_t *)buf, sizeof(buf));
|
|
if (read > 0) {
|
|
for (size_t i = 0; i < sizeof(buf); i++) {
|
|
serialproc_write(buf[i]);
|
|
}
|
|
}
|
|
|
|
if (serialproc_received() == 0) {
|
|
continue;
|
|
}
|
|
|
|
uint8_t inchar = io_in8(SERIAL_PORT);
|
|
ipc_pipewrite(SERIALPROC->pipes[0], &inchar, sizeof(inchar));
|
|
}
|
|
}
|