Serial comm kernel process
This commit is contained in:
73
kernel/proc/serialproc/serialproc.c
Normal file
73
kernel/proc/serialproc/serialproc.c
Normal file
@ -0,0 +1,73 @@
|
||||
#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));
|
||||
}
|
||||
}
|
Reference in New Issue
Block a user