* initial posix_io support
This commit is contained in:
parent
02e26536f0
commit
948e430148
@ -3,4 +3,4 @@ SubDir TOP board msba2 drivers ;
|
|||||||
Module board_cc1100 : msba2-cc1100.c ;
|
Module board_cc1100 : msba2-cc1100.c ;
|
||||||
Module board_hal : msba2-hal.c ;
|
Module board_hal : msba2-hal.c ;
|
||||||
Module board_ltc4150 : msba2-ltc4150.c : gpioint ;
|
Module board_ltc4150 : msba2-ltc4150.c : gpioint ;
|
||||||
Module board_common : msba2-uart0.c ;
|
Module board_common : msba2-uart0.c msba2-uart0_thread.c : ringbuffer ;
|
||||||
|
|||||||
8
board/msba2/drivers/include/uart0.h
Normal file
8
board/msba2/drivers/include/uart0.h
Normal file
@ -0,0 +1,8 @@
|
|||||||
|
#ifndef __UART0_H
|
||||||
|
#define __UART0_H
|
||||||
|
|
||||||
|
#define UART0_BUFSIZE 32
|
||||||
|
|
||||||
|
extern int uart0_handler_pid;
|
||||||
|
|
||||||
|
#endif /* __UART0_H */
|
||||||
101
board/msba2/drivers/msba2-uart0_thread.c
Normal file
101
board/msba2/drivers/msba2-uart0_thread.c
Normal file
@ -0,0 +1,101 @@
|
|||||||
|
#include <thread.h>
|
||||||
|
#include <kernel.h>
|
||||||
|
#include <msg.h>
|
||||||
|
#include <board.h>
|
||||||
|
#include <ringbuffer.h>
|
||||||
|
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <errno.h>
|
||||||
|
#include <irq.h>
|
||||||
|
#include <posix_io.h>
|
||||||
|
#include "uart0.h"
|
||||||
|
|
||||||
|
//#define ENABLE_DEBUG
|
||||||
|
#include <debug.h>
|
||||||
|
|
||||||
|
static char buffer[UART0_BUFSIZE];
|
||||||
|
ringbuffer uart0_ringbuffer;
|
||||||
|
|
||||||
|
static void uart0_loop();
|
||||||
|
|
||||||
|
void uart0_init() {
|
||||||
|
ringbuffer_init(&uart0_ringbuffer, buffer, UART0_BUFSIZE);
|
||||||
|
int pid = thread_create(KERNEL_CONF_STACKSIZE_MAIN, PRIORITY_MAIN-1, CREATE_STACKTEST, uart0_loop, "uart0");
|
||||||
|
uart0_handler_pid = pid;
|
||||||
|
puts("uart0_init() [OK]");
|
||||||
|
}
|
||||||
|
|
||||||
|
static int min(int a, int b) {
|
||||||
|
if (b>a) return a;
|
||||||
|
else return b;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void uart0_loop() {
|
||||||
|
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 (uart0_ringbuffer.avail && (r != NULL)) {
|
||||||
|
int state = disableIRQ();
|
||||||
|
int nbytes = min(r->nbytes, uart0_ringbuffer.avail);
|
||||||
|
DEBUG("uart0_thread: sending %i bytes to pid %i\n", nbytes, reader_pid);
|
||||||
|
rb_get_elements(&uart0_ringbuffer, 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);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
@ -6,6 +6,6 @@
|
|||||||
|
|
||||||
SubDir TOP projects test_shell ;
|
SubDir TOP projects test_shell ;
|
||||||
|
|
||||||
Module test_shell : test_shell.c : shell ;
|
Module test_shell : test_shell.c : shell posix_io ;
|
||||||
|
|
||||||
UseModule test_shell ;
|
UseModule test_shell ;
|
||||||
|
|||||||
@ -6,6 +6,8 @@
|
|||||||
#include <string.h>
|
#include <string.h>
|
||||||
#include <malloc.h>
|
#include <malloc.h>
|
||||||
|
|
||||||
|
#include <uart0.h>
|
||||||
|
#include <posix_io.h>
|
||||||
#include <shell.h>
|
#include <shell.h>
|
||||||
|
|
||||||
void print_teststart(char* str) {
|
void print_teststart(char* str) {
|
||||||
@ -16,8 +18,14 @@ void print_testend(char* str) {
|
|||||||
printf("[TEST_END]\n");
|
printf("[TEST_END]\n");
|
||||||
}
|
}
|
||||||
|
|
||||||
extern int uart0_init();
|
//extern int uart0_init();
|
||||||
extern int uart0_readc();
|
//extern int uart0_handler_pid;
|
||||||
|
|
||||||
|
int shell_readc() {
|
||||||
|
char c = 0;
|
||||||
|
posix_read(uart0_handler_pid, &c, 1);
|
||||||
|
return c;
|
||||||
|
}
|
||||||
|
|
||||||
int main(void) {
|
int main(void) {
|
||||||
//printf("Moin. build on %s %s SVN-Revision: %s\n", kernel_builddate, kernel_buildtime, kernel_svnrevision);
|
//printf("Moin. build on %s %s SVN-Revision: %s\n", kernel_builddate, kernel_buildtime, kernel_svnrevision);
|
||||||
@ -25,8 +33,10 @@ int main(void) {
|
|||||||
|
|
||||||
uart0_init();
|
uart0_init();
|
||||||
|
|
||||||
|
posix_open(uart0_handler_pid, 0);
|
||||||
|
|
||||||
shell_t shell;
|
shell_t shell;
|
||||||
shell_init(&shell, uart0_readc);
|
shell_init(&shell, shell_readc);
|
||||||
|
|
||||||
shell_register_cmd(&shell, "start_test", print_teststart);
|
shell_register_cmd(&shell, "start_test", print_teststart);
|
||||||
shell_register_cmd(&shell, "end_test", print_testend);
|
shell_register_cmd(&shell, "end_test", print_testend);
|
||||||
|
|||||||
@ -28,7 +28,8 @@
|
|||||||
SubDir TOP sys ;
|
SubDir TOP sys ;
|
||||||
|
|
||||||
Module swtimer : swtimer.c : hwtimer ;
|
Module swtimer : swtimer.c : hwtimer ;
|
||||||
Module shell : shell.c sync_read.c : hashtable hash_string ringbuffer ;
|
Module posix_io : posix_io.c ;
|
||||||
|
Module shell : shell.c : hashtable hash_string ;
|
||||||
|
|
||||||
Module auto_init : auto_init.c ;
|
Module auto_init : auto_init.c ;
|
||||||
|
|
||||||
|
|||||||
19
sys/include/posix_io.h
Normal file
19
sys/include/posix_io.h
Normal file
@ -0,0 +1,19 @@
|
|||||||
|
#ifndef __READ_H
|
||||||
|
#define __READ_H
|
||||||
|
|
||||||
|
#define OPEN 0
|
||||||
|
#define CLOSE 1
|
||||||
|
#define READ 2
|
||||||
|
#define WRITE 3
|
||||||
|
|
||||||
|
struct posix_iop {
|
||||||
|
int nbytes;
|
||||||
|
char *buffer;
|
||||||
|
};
|
||||||
|
|
||||||
|
int posix_open(int pid, int flags);
|
||||||
|
int posix_close(int pid);
|
||||||
|
int posix_read(int pid, char* buffer, int bufsize);
|
||||||
|
int posix_write(int pid, char* buffer, int bufsize);
|
||||||
|
|
||||||
|
#endif /* __READ_H */
|
||||||
42
sys/posix_io.c
Normal file
42
sys/posix_io.c
Normal file
@ -0,0 +1,42 @@
|
|||||||
|
#include <msg.h>
|
||||||
|
|
||||||
|
#include <posix_io.h>
|
||||||
|
|
||||||
|
|
||||||
|
static int _posix_fileop(int pid, int op, int flags) {
|
||||||
|
msg m;
|
||||||
|
m.type = op;
|
||||||
|
m.content.value = flags;
|
||||||
|
msg_send_receive(&m, &m, pid);
|
||||||
|
return m.content.value;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int _posix_fileop_data(int pid, int op, char* buffer, int nbytes) {
|
||||||
|
struct posix_iop r;
|
||||||
|
r.nbytes = nbytes;
|
||||||
|
r.buffer = buffer;
|
||||||
|
|
||||||
|
msg m;
|
||||||
|
m.type = op;
|
||||||
|
m.content.ptr = (char*) &r;
|
||||||
|
|
||||||
|
msg_send_receive(&m, &m, pid);
|
||||||
|
|
||||||
|
return r.nbytes;
|
||||||
|
}
|
||||||
|
|
||||||
|
int posix_open(int pid, int flags) {
|
||||||
|
return _posix_fileop(pid, OPEN, flags);
|
||||||
|
}
|
||||||
|
|
||||||
|
int posix_close(int pid) {
|
||||||
|
return _posix_fileop(pid, CLOSE, 0);
|
||||||
|
}
|
||||||
|
|
||||||
|
int posix_read(int pid, char* buffer, int bufsize) {
|
||||||
|
return _posix_fileop_data(pid, READ, buffer, bufsize);
|
||||||
|
}
|
||||||
|
|
||||||
|
int posix_write(int pid, char* buffer, int bufsize) {
|
||||||
|
return _posix_fileop_data(pid, WRITE, buffer, bufsize);
|
||||||
|
}
|
||||||
30
sys/shell.c
30
sys/shell.c
@ -60,25 +60,20 @@ static void handle_input_line(shell_t *shell, char* line) {
|
|||||||
if (handler) {
|
if (handler) {
|
||||||
handler(line);
|
handler(line);
|
||||||
} else {
|
} else {
|
||||||
printf("shell: command not found.\n");
|
printf("shell: command \"%s\" not found.\n", command);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
free(line);
|
free(line);
|
||||||
}
|
}
|
||||||
|
|
||||||
void shell_run(shell_t *shell) {
|
int readline(shell_t *shell, char* buf, int size) {
|
||||||
char line_buf[255];
|
char *line_buf_ptr = buf;
|
||||||
char *line_buf_ptr = line_buf;
|
|
||||||
int c;
|
int c;
|
||||||
|
|
||||||
while (1) {
|
while (1) {
|
||||||
write(STDOUT_FILENO, ">", 1);
|
if ( (line_buf_ptr - buf) >= size-1) {
|
||||||
|
return -1;
|
||||||
while (1) {
|
|
||||||
if ( (line_buf_ptr - line_buf) >= (sizeof(line_buf)-1)) {
|
|
||||||
printf("\nshell: input too long.\n");
|
|
||||||
line_buf_ptr = line_buf;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
c = shell->readchar();
|
c = shell->readchar();
|
||||||
@ -89,14 +84,23 @@ void shell_run(shell_t *shell) {
|
|||||||
|
|
||||||
if (c == 10) {
|
if (c == 10) {
|
||||||
*line_buf_ptr = '\0';
|
*line_buf_ptr = '\0';
|
||||||
handle_input_line(shell, strdup(line_buf));
|
return 0;
|
||||||
line_buf_ptr = line_buf;
|
|
||||||
break;
|
|
||||||
} else {
|
} else {
|
||||||
*line_buf_ptr++ = c;
|
*line_buf_ptr++ = c;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void shell_run(shell_t *shell) {
|
||||||
|
char line_buf[255];
|
||||||
|
|
||||||
|
while(1) {
|
||||||
|
write(STDOUT_FILENO, ">", 1);
|
||||||
|
int res = readline(shell, line_buf, sizeof(line_buf));
|
||||||
|
if (! res ) {
|
||||||
|
handle_input_line(shell, strdup(line_buf));
|
||||||
|
}
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
void shell_init(shell_t *shell, int(*readchar)(void)) {
|
void shell_init(shell_t *shell, int(*readchar)(void)) {
|
||||||
|
|||||||
@ -1,98 +0,0 @@
|
|||||||
/******************************************************************************
|
|
||||||
Copyright 2009, Freie Universitaet Berlin (FUB). All rights reserved.
|
|
||||||
|
|
||||||
These sources were developed at the Freie Universitaet Berlin, Computer Systems
|
|
||||||
and Telematics group (http://cst.mi.fu-berlin.de).
|
|
||||||
-------------------------------------------------------------------------------
|
|
||||||
This file is part of FeuerWare.
|
|
||||||
|
|
||||||
This program is free software: you can redistribute it and/or modify it under
|
|
||||||
the terms of the GNU General Public License as published by the Free Software
|
|
||||||
Foundation, either version 3 of the License, or (at your option) any later
|
|
||||||
version.
|
|
||||||
|
|
||||||
FeuerWare is distributed in the hope that it will be useful, but WITHOUT
|
|
||||||
ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
|
|
||||||
FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details.
|
|
||||||
|
|
||||||
You should have received a copy of the GNU General Public License along with
|
|
||||||
this program. If not, see http://www.gnu.org/licenses/ .
|
|
||||||
--------------------------------------------------------------------------------
|
|
||||||
For further information and questions please use the web site
|
|
||||||
http://scatterweb.mi.fu-berlin.de
|
|
||||||
and the mailinglist (subscription via web site)
|
|
||||||
scatterweb@lists.spline.inf.fu-berlin.de
|
|
||||||
*******************************************************************************/
|
|
||||||
#include <ringbuffer.h>
|
|
||||||
#include <mutex.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include <kernel.h>
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @file
|
|
||||||
* @ingroup simple_shell
|
|
||||||
* @brief contains implementation of synchronous read functions,
|
|
||||||
* @brief hardcoded to uart0
|
|
||||||
* @author Kaspar Schleiser
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
|
|
||||||
extern void (*uart0_callback)(int);
|
|
||||||
|
|
||||||
#define UART0_BUFSIZE 255
|
|
||||||
static ringbuffer uart0_rb;
|
|
||||||
static char uart0_buffer[UART0_BUFSIZE];
|
|
||||||
static char uart0_waiting = 0;
|
|
||||||
|
|
||||||
static mutex_t uart0_mutex;
|
|
||||||
|
|
||||||
void uart0_process_byte(int c) {
|
|
||||||
rb_add_element(&uart0_rb, c);
|
|
||||||
|
|
||||||
if (uart0_waiting) {
|
|
||||||
uart0_waiting = 0;
|
|
||||||
mutex_unlock(&uart0_mutex, false);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void uart0_init() {
|
|
||||||
dINT();
|
|
||||||
mutex_init(&uart0_mutex);
|
|
||||||
mutex_lock(&uart0_mutex);
|
|
||||||
ringbuffer_init(&uart0_rb, uart0_buffer, UART0_BUFSIZE);
|
|
||||||
uart0_callback = uart0_process_byte;
|
|
||||||
eINT();
|
|
||||||
}
|
|
||||||
|
|
||||||
/** @brief read a char from uart0. Block if none available. */
|
|
||||||
int uart0_readc() {
|
|
||||||
dINT();
|
|
||||||
|
|
||||||
if (uart0_rb.avail == 0) {
|
|
||||||
uart0_waiting++;
|
|
||||||
mutex_lock(&uart0_mutex);
|
|
||||||
}
|
|
||||||
|
|
||||||
int c = rb_get_element(&uart0_rb);
|
|
||||||
|
|
||||||
eINT();
|
|
||||||
|
|
||||||
return c;
|
|
||||||
}
|
|
||||||
|
|
||||||
/** @brief read a char from uart0. return -1 if none available */
|
|
||||||
int uart0_readc_nb() {
|
|
||||||
dINT();
|
|
||||||
|
|
||||||
if (uart0_rb.avail == 0) {
|
|
||||||
eINT();
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
|
|
||||||
int c = rb_get_element(&uart0_rb);
|
|
||||||
|
|
||||||
eINT();
|
|
||||||
|
|
||||||
return c;
|
|
||||||
}
|
|
||||||
|
|
||||||
Loading…
x
Reference in New Issue
Block a user