* refactored uart / chardev handling
parent
867fd7f293
commit
b8ca7edac8
@ -0,0 +1,87 @@
|
||||
#include <thread.h>
|
||||
#include <kernel.h>
|
||||
#include <msg.h>
|
||||
#include <ringbuffer.h>
|
||||
|
||||
#include <stdio.h>
|
||||
#include <errno.h>
|
||||
#include <irq.h>
|
||||
#include <posix_io.h>
|
||||
|
||||
//#define ENABLE_DEBUG
|
||||
#include <debug.h>
|
||||
|
||||
static int min(int a, int b) {
|
||||
if (b>a) return a;
|
||||
else return b;
|
||||
}
|
||||
|
||||
void chardev_loop(ringbuffer *rb) {
|
||||
msg m;
|
||||
|
||||
int pid = thread_getpid();
|
||||
|
||||
int reader_pid = -1;
|
||||
struct posix_iop *r = NULL;
|
||||
|
||||
puts("UART0 thread started.");
|
||||
|
||||
while (1) {
|
||||
msg_receive(&m);
|
||||
|
||||
if (m.sender_pid == pid) {
|
||||
} else {
|
||||
switch (m.type) {
|
||||
case OPEN:
|
||||
if (reader_pid == -1) {
|
||||
reader_pid = m.sender_pid;
|
||||
m.content.value = 0; // no error
|
||||
} else {
|
||||
m.content.value = -EBUSY;
|
||||
}
|
||||
msg_reply(&m,&m);
|
||||
break;
|
||||
case READ:
|
||||
if (m.sender_pid != reader_pid) {
|
||||
m.content.value = -EINVAL;
|
||||
msg_reply(&m, &m);
|
||||
} else {
|
||||
r = (struct posix_iop *)m.content.ptr;
|
||||
}
|
||||
break;
|
||||
case CLOSE:
|
||||
if (m.sender_pid == reader_pid) {
|
||||
DEBUG("uart0_thread: closing file from %i\n", reader_pid);
|
||||
reader_pid = -1;
|
||||
r = NULL;
|
||||
m.content.value = 0;
|
||||
} else {
|
||||
m.content.value = -EINVAL;
|
||||
}
|
||||
msg_reply(&m,&m);
|
||||
break;
|
||||
default:
|
||||
m.content.value = -EINVAL;
|
||||
msg_reply(&m, &m);
|
||||
}
|
||||
}
|
||||
|
||||
if (rb->avail && (r != NULL)) {
|
||||
int state = disableIRQ();
|
||||
int nbytes = min(r->nbytes, rb->avail);
|
||||
DEBUG("uart0_thread: sending %i bytes to pid %i\n", nbytes, reader_pid);
|
||||
rb_get_elements(rb, r->buffer, nbytes);
|
||||
r->nbytes = nbytes;
|
||||
|
||||
m.sender_pid = reader_pid;
|
||||
m.type = OPEN;
|
||||
m.content.ptr = (char*)r;
|
||||
|
||||
msg_reply(&m, &m);
|
||||
// DEBUG("uart0_thread: sending res=%i\n", res);
|
||||
|
||||
r = NULL;
|
||||
restoreIRQ(state);
|
||||
}
|
||||
}
|
||||
}
|
@ -0,0 +1,8 @@
|
||||
#ifndef __BOARD_UART0_H
|
||||
#define __BOARD_UART0_H
|
||||
|
||||
extern int uart0_handler_pid;
|
||||
|
||||
void board_uart0_init();
|
||||
|
||||
#endif /* __BOARD_UART0_H */
|
@ -0,0 +1,8 @@
|
||||
#ifndef __CHARDEV_THREAD_H
|
||||
#define __CHARDEV_THREAD_H
|
||||
|
||||
#include <ringbuffer.h>
|
||||
|
||||
void chardev_loop(ringbuffer *rb);
|
||||
|
||||
#endif /* __CHARDEV_THREAD_H */
|
Loading…
Reference in New Issue