|
|
|
|
@ -17,23 +17,15 @@ 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
|
|
|
|
|
*******************************************************************************/
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* @file
|
|
|
|
|
* @ingroup lpc2387
|
|
|
|
|
* @brief LPC2387 NewLib system calls implementation
|
|
|
|
|
* @ingroup lpc2387
|
|
|
|
|
* @brief LPC2387 NewLib system calls implementation
|
|
|
|
|
*
|
|
|
|
|
* @author Freie Universität Berlin, Computer Systems & Telematics
|
|
|
|
|
* @author Michael Baar <michael.baar@fu-berlin.de>
|
|
|
|
|
* @version $Revision$
|
|
|
|
|
* @author Michael Baar <michael.baar@fu-berlin.de>
|
|
|
|
|
*
|
|
|
|
|
* @note $Id$
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
#include <errno.h>
|
|
|
|
|
@ -56,9 +48,9 @@ and the mailinglist (subscription via web site)
|
|
|
|
|
#include "hal-syscalls.h"
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
#define DEBUG_SYSCALLS 0
|
|
|
|
|
#define DEBUG_SYSCALLS 0
|
|
|
|
|
#if DEBUG_SYSCALLS
|
|
|
|
|
#define PRINTF(...) printf(__VA_ARGS__)
|
|
|
|
|
#define PRINTF(...) printf(__VA_ARGS__)
|
|
|
|
|
#else
|
|
|
|
|
#define PRINTF(...)
|
|
|
|
|
#endif
|
|
|
|
|
@ -71,14 +63,14 @@ and the mailinglist (subscription via web site)
|
|
|
|
|
* @name Heaps (defined in linker script)
|
|
|
|
|
* @{
|
|
|
|
|
*/
|
|
|
|
|
#define NUM_HEAPS 3//2
|
|
|
|
|
#define NUM_HEAPS 3//2
|
|
|
|
|
|
|
|
|
|
extern uintptr_t __heap1_start; ///< start of heap memory space
|
|
|
|
|
extern uintptr_t __heap1_max; ///< maximum for end of heap memory space
|
|
|
|
|
extern uintptr_t __heap2_start; ///< start of heap memory space
|
|
|
|
|
extern uintptr_t __heap2_max; ///< maximum for end of heap memory space
|
|
|
|
|
extern uintptr_t __heap3_start; ///< start of heap memory space
|
|
|
|
|
extern uintptr_t __heap3_max; ///< maximum for end of heap memory space
|
|
|
|
|
extern uintptr_t __heap1_start; ///< start of heap memory space
|
|
|
|
|
extern uintptr_t __heap1_max; ///< maximum for end of heap memory space
|
|
|
|
|
extern uintptr_t __heap2_start; ///< start of heap memory space
|
|
|
|
|
extern uintptr_t __heap2_max; ///< maximum for end of heap memory space
|
|
|
|
|
extern uintptr_t __heap3_start; ///< start of heap memory space
|
|
|
|
|
extern uintptr_t __heap3_max; ///< maximum for end of heap memory space
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/// current position in heap
|
|
|
|
|
@ -92,25 +84,27 @@ static const caddr_t heap_start[NUM_HEAPS] = {(caddr_t)&__heap1_start,(caddr_t)&
|
|
|
|
|
/** @} */
|
|
|
|
|
|
|
|
|
|
/*-----------------------------------------------------------------------------------*/
|
|
|
|
|
void heap_stats(void) {
|
|
|
|
|
for(int i = 0; i < NUM_HEAPS; i++)
|
|
|
|
|
printf("# heap %i: %p -- %p -> %p (%li of %li free)\n", i, heap_start[i], heap[i], heap_max[i],
|
|
|
|
|
(uint32_t)heap_max[i] - (uint32_t)heap[i], (uint32_t)heap_max[i] - (uint32_t)heap_start[i]);
|
|
|
|
|
void heap_stats(void)
|
|
|
|
|
{
|
|
|
|
|
for(int i = 0; i < NUM_HEAPS; i++)
|
|
|
|
|
printf("# heap %i: %p -- %p -> %p (%li of %li free)\n", i, heap_start[i], heap[i], heap_max[i],
|
|
|
|
|
(uint32_t)heap_max[i] - (uint32_t)heap[i], (uint32_t)heap_max[i] - (uint32_t)heap_start[i]);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*-----------------------------------------------------------------------------------*/
|
|
|
|
|
void __assert_func(const char *file, int line, const char *func, const char *failedexpr)
|
|
|
|
|
{
|
|
|
|
|
#if SYSLOG_CONF_ASSERT
|
|
|
|
|
trace_number(TRACELOG_EV_ASSERTION, line);
|
|
|
|
|
syslog(SL_EMERGENCY, "assert", "%s() in %s:%u\n", func, file, line);
|
|
|
|
|
trace_number(TRACELOG_EV_ASSERTION, line);
|
|
|
|
|
syslog(SL_EMERGENCY, "assert", "%s() in %s:%u\n", func, file, line);
|
|
|
|
|
#endif
|
|
|
|
|
printf("#! assertion %s failed\n\t%s() in %s:%u\n", failedexpr, func, file, line );
|
|
|
|
|
_exit(3);
|
|
|
|
|
printf("#! assertion %s failed\n\t%s() in %s:%u\n", failedexpr, func, file, line );
|
|
|
|
|
_exit(3);
|
|
|
|
|
}
|
|
|
|
|
/*-----------------------------------------------------------------------------------*/
|
|
|
|
|
void __assert(const char *file, int line, const char *failedexpr)
|
|
|
|
|
{
|
|
|
|
|
__assert_func(file, line, "?", failedexpr);
|
|
|
|
|
__assert_func(file, line, "?", failedexpr);
|
|
|
|
|
}
|
|
|
|
|
/*-----------------------------------------------------------------------------------*/
|
|
|
|
|
caddr_t _sbrk_r(struct _reent *r, size_t incr)
|
|
|
|
|
@ -125,198 +119,198 @@ caddr_t _sbrk_r(struct _reent *r, size_t incr)
|
|
|
|
|
uint32_t cpsr = disableIRQ();
|
|
|
|
|
|
|
|
|
|
/* check all heaps for a chunk of the requested size */
|
|
|
|
|
for(volatile uint8_t iUsedHeap = 0; iUsedHeap < NUM_HEAPS; iUsedHeap++ ) {
|
|
|
|
|
caddr_t new_heap = heap[iUsedHeap] + incr;
|
|
|
|
|
|
|
|
|
|
#ifdef MODULE_TRACELOG
|
|
|
|
|
trace_pointer(TRACELOG_EV_MEMORY, heap[iUsedHeap]);
|
|
|
|
|
#endif
|
|
|
|
|
if( new_heap <= heap_max[iUsedHeap] ) {
|
|
|
|
|
caddr_t prev_heap = heap[iUsedHeap];
|
|
|
|
|
#ifdef MODULE_TRACELOG
|
|
|
|
|
trace_pointer(TRACELOG_EV_MEMORY, new_heap);
|
|
|
|
|
#endif
|
|
|
|
|
heap[iUsedHeap] = new_heap;
|
|
|
|
|
|
|
|
|
|
r->_errno = 0;
|
|
|
|
|
restoreIRQ(cpsr);
|
|
|
|
|
return prev_heap;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
restoreIRQ(cpsr);
|
|
|
|
|
#ifdef MODULE_TRACELOG
|
|
|
|
|
trace_string(TRACELOG_EV_MEMORY, "heap!"); // heap full
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
r->_errno = ENOMEM;
|
|
|
|
|
for (volatile uint8_t iUsedHeap = 0; iUsedHeap < NUM_HEAPS; iUsedHeap++ ) {
|
|
|
|
|
caddr_t new_heap = heap[iUsedHeap] + incr;
|
|
|
|
|
|
|
|
|
|
#ifdef MODULE_TRACELOG
|
|
|
|
|
trace_pointer(TRACELOG_EV_MEMORY, heap[iUsedHeap]);
|
|
|
|
|
#endif
|
|
|
|
|
if( new_heap <= heap_max[iUsedHeap] ) {
|
|
|
|
|
caddr_t prev_heap = heap[iUsedHeap];
|
|
|
|
|
#ifdef MODULE_TRACELOG
|
|
|
|
|
trace_pointer(TRACELOG_EV_MEMORY, new_heap);
|
|
|
|
|
#endif
|
|
|
|
|
heap[iUsedHeap] = new_heap;
|
|
|
|
|
|
|
|
|
|
r->_errno = 0;
|
|
|
|
|
restoreIRQ(cpsr);
|
|
|
|
|
return prev_heap;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
restoreIRQ(cpsr);
|
|
|
|
|
#ifdef MODULE_TRACELOG
|
|
|
|
|
trace_string(TRACELOG_EV_MEMORY, "heap!"); // heap full
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
r->_errno = ENOMEM;
|
|
|
|
|
return NULL;
|
|
|
|
|
}
|
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
|
int _isatty_r(struct _reent *r, int fd)
|
|
|
|
|
{
|
|
|
|
|
r->_errno = 0;
|
|
|
|
|
if( fd == STDOUT_FILENO || fd == STDERR_FILENO )
|
|
|
|
|
return 1;
|
|
|
|
|
else
|
|
|
|
|
return 0;
|
|
|
|
|
r->_errno = 0;
|
|
|
|
|
if( fd == STDOUT_FILENO || fd == STDERR_FILENO )
|
|
|
|
|
return 1;
|
|
|
|
|
else
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
|
_off_t _lseek_r(struct _reent *r, int fd, _off_t pos, int whence)
|
|
|
|
|
{
|
|
|
|
|
_off_t result = -1;
|
|
|
|
|
PRINTF("lseek [%i] pos %li whence %i\n", fd, pos, whence);
|
|
|
|
|
_off_t result = -1;
|
|
|
|
|
PRINTF("lseek [%i] pos %li whence %i\n", fd, pos, whence);
|
|
|
|
|
|
|
|
|
|
r->_errno = ENODEV;
|
|
|
|
|
r->_errno = ENODEV;
|
|
|
|
|
#ifdef MODULE_FAT
|
|
|
|
|
result = ff_lseek_r(r, fd, pos, whence);
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
PRINTF("lseek returned %li (0 is success)\n", result);
|
|
|
|
|
return result;
|
|
|
|
|
PRINTF("lseek returned %li (0 is success)\n", result);
|
|
|
|
|
return result;
|
|
|
|
|
}
|
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
|
int _open_r(struct _reent *r, const char *name, int mode)
|
|
|
|
|
{
|
|
|
|
|
int ret = -1;
|
|
|
|
|
PRINTF("open '%s' mode %#x\n", name, mode);
|
|
|
|
|
int ret = -1;
|
|
|
|
|
PRINTF("open '%s' mode %#x\n", name, mode);
|
|
|
|
|
|
|
|
|
|
r->_errno = ENODEV; // no such device
|
|
|
|
|
r->_errno = ENODEV; // no such device
|
|
|
|
|
#ifdef MODULE_FAT
|
|
|
|
|
ret = ff_open_r(r,name,mode);
|
|
|
|
|
ret = ff_open_r(r,name,mode);
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
PRINTF("open [%i] errno %i\n", ret, r->_errno);
|
|
|
|
|
return ret;
|
|
|
|
|
PRINTF("open [%i] errno %i\n", ret, r->_errno);
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
|
int _stat_r(struct _reent *r, char *name, struct stat *st)
|
|
|
|
|
{
|
|
|
|
|
int ret = -1;
|
|
|
|
|
PRINTF("_stat_r '%s' \n", name);
|
|
|
|
|
r->_errno = ENODEV; // no such device
|
|
|
|
|
int ret = -1;
|
|
|
|
|
PRINTF("_stat_r '%s' \n", name);
|
|
|
|
|
r->_errno = ENODEV; // no such device
|
|
|
|
|
#ifdef MODULE_FAT
|
|
|
|
|
ret = ff_stat_r(r,name,st);
|
|
|
|
|
ret = ff_stat_r(r,name,st);
|
|
|
|
|
#endif
|
|
|
|
|
PRINTF("_stat_r [%i] errno %i\n", ret, r->_errno);
|
|
|
|
|
return ret;
|
|
|
|
|
PRINTF("_stat_r [%i] errno %i\n", ret, r->_errno);
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
|
int _fstat_r(struct _reent *r, int fd, struct stat * st)
|
|
|
|
|
{
|
|
|
|
|
int ret = -1;
|
|
|
|
|
int ret = -1;
|
|
|
|
|
|
|
|
|
|
r->_errno = 0;
|
|
|
|
|
memset(st, 0, sizeof(*st));
|
|
|
|
|
if( fd == STDOUT_FILENO || fd == STDERR_FILENO ) {
|
|
|
|
|
st->st_mode = S_IFCHR;
|
|
|
|
|
ret = 0;
|
|
|
|
|
} else {
|
|
|
|
|
r->_errno = 0;
|
|
|
|
|
memset(st, 0, sizeof(*st));
|
|
|
|
|
if( fd == STDOUT_FILENO || fd == STDERR_FILENO ) {
|
|
|
|
|
st->st_mode = S_IFCHR;
|
|
|
|
|
ret = 0;
|
|
|
|
|
} else {
|
|
|
|
|
|
|
|
|
|
#ifdef MODULE_FAT
|
|
|
|
|
PRINTF("_fstat_r '%i' \n", fd);
|
|
|
|
|
PRINTF("_fstat_r '%i' \n", fd);
|
|
|
|
|
|
|
|
|
|
ret = ff_fstat_r(r,fd,st);
|
|
|
|
|
PRINTF("_fstat_r [%i] errno %i\n", ret, r->_errno);
|
|
|
|
|
ret = ff_fstat_r(r,fd,st);
|
|
|
|
|
PRINTF("_fstat_r [%i] errno %i\n", ret, r->_errno);
|
|
|
|
|
|
|
|
|
|
#else
|
|
|
|
|
r->_errno = ENODEV;
|
|
|
|
|
r->_errno = ENODEV;
|
|
|
|
|
#endif
|
|
|
|
|
}
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
|
int _write_r(struct _reent *r, int fd, const void *data, unsigned int count)
|
|
|
|
|
{
|
|
|
|
|
int result = EOF;
|
|
|
|
|
r->_errno = EBADF;
|
|
|
|
|
|
|
|
|
|
switch(fd) {
|
|
|
|
|
case STDOUT_FILENO:
|
|
|
|
|
case STDERR_FILENO:
|
|
|
|
|
#if FEUERWARE_CONF_ENABLE_HAL
|
|
|
|
|
if( stdio != NULL )
|
|
|
|
|
result = chardevice_write(stdio, (char*)data, count);
|
|
|
|
|
else if( hal_state == HAL_NOT_INITIALIZED )
|
|
|
|
|
result = fw_puts((char*)data, count);
|
|
|
|
|
#else
|
|
|
|
|
result = fw_puts((char*)data, count);
|
|
|
|
|
#endif
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
default:
|
|
|
|
|
#ifdef MODULE_FAT
|
|
|
|
|
result = ff_write_r(r, fd, data, count);
|
|
|
|
|
#endif
|
|
|
|
|
PRINTF("write [%i] data @%p count %i\n", fd, data, count);
|
|
|
|
|
|
|
|
|
|
PRINTF("write [%i] returned %i errno %i\n", fd, result, r->_errno);
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return result;
|
|
|
|
|
int result = EOF;
|
|
|
|
|
r->_errno = EBADF;
|
|
|
|
|
|
|
|
|
|
switch(fd) {
|
|
|
|
|
case STDOUT_FILENO:
|
|
|
|
|
case STDERR_FILENO:
|
|
|
|
|
#if FEUERWARE_CONF_ENABLE_HAL
|
|
|
|
|
if( stdio != NULL )
|
|
|
|
|
result = chardevice_write(stdio, (char*)data, count);
|
|
|
|
|
else if( hal_state == HAL_NOT_INITIALIZED )
|
|
|
|
|
result = fw_puts((char*)data, count);
|
|
|
|
|
#else
|
|
|
|
|
result = fw_puts((char*)data, count);
|
|
|
|
|
#endif
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
default:
|
|
|
|
|
#ifdef MODULE_FAT
|
|
|
|
|
result = ff_write_r(r, fd, data, count);
|
|
|
|
|
#endif
|
|
|
|
|
PRINTF("write [%i] data @%p count %i\n", fd, data, count);
|
|
|
|
|
|
|
|
|
|
PRINTF("write [%i] returned %i errno %i\n", fd, result, r->_errno);
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return result;
|
|
|
|
|
}
|
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
|
int _read_r(struct _reent *r, int fd, void *buffer, unsigned int count)
|
|
|
|
|
{
|
|
|
|
|
int result = -1;
|
|
|
|
|
r->_errno = EBADF;
|
|
|
|
|
int result = -1;
|
|
|
|
|
r->_errno = EBADF;
|
|
|
|
|
#ifdef MODULE_FAT
|
|
|
|
|
result = ff_read_r(r, fd, buffer, count);
|
|
|
|
|
result = ff_read_r(r, fd, buffer, count);
|
|
|
|
|
#endif
|
|
|
|
|
PRINTF("read [%i] buffer @%p count %i\n", fd, buffer, count);
|
|
|
|
|
PRINTF("read [%i] returned %i\n", fd, result);
|
|
|
|
|
|
|
|
|
|
PRINTF("read [%i] returned %i\n", fd, result);
|
|
|
|
|
|
|
|
|
|
return result;
|
|
|
|
|
}
|
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
|
int _close_r(struct _reent *r, int fd)
|
|
|
|
|
{
|
|
|
|
|
int result = -1;
|
|
|
|
|
r->_errno = EBADF;
|
|
|
|
|
#ifdef MODULE_FAT
|
|
|
|
|
ret = ff_close_r(r, fd);
|
|
|
|
|
#endif
|
|
|
|
|
int result = -1;
|
|
|
|
|
r->_errno = EBADF;
|
|
|
|
|
#ifdef MODULE_FAT
|
|
|
|
|
ret = ff_close_r(r, fd);
|
|
|
|
|
#endif
|
|
|
|
|
PRINTF("close [%i]\n", fd);
|
|
|
|
|
PRINTF("close returned %i errno %i\n", result, errno);
|
|
|
|
|
|
|
|
|
|
PRINTF("close returned %i errno %i\n", result, errno);
|
|
|
|
|
|
|
|
|
|
return result;
|
|
|
|
|
}
|
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
|
int _unlink_r(struct _reent *r, char* path)
|
|
|
|
|
{
|
|
|
|
|
int result = -1;
|
|
|
|
|
r->_errno = ENODEV;
|
|
|
|
|
int result = -1;
|
|
|
|
|
r->_errno = ENODEV;
|
|
|
|
|
#ifdef MODULE_FAT
|
|
|
|
|
result = ff_unlink_r(r, path);
|
|
|
|
|
result = ff_unlink_r(r, path);
|
|
|
|
|
#endif
|
|
|
|
|
PRINTF("unlink '%s'\n", path);
|
|
|
|
|
PRINTF("unlink returned %i errno %i\n", result, errno);
|
|
|
|
|
|
|
|
|
|
PRINTF("unlink returned %i errno %i\n", result, errno);
|
|
|
|
|
|
|
|
|
|
return result;
|
|
|
|
|
}
|
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
|
void _exit(int n)
|
|
|
|
|
{
|
|
|
|
|
#ifdef MODULE_TRACELOG
|
|
|
|
|
trace_number(TRACELOG_EV_EXIT, n);
|
|
|
|
|
trace_number(TRACELOG_EV_EXIT, n);
|
|
|
|
|
#endif
|
|
|
|
|
printf("#! exit %i: resetting\n", n);
|
|
|
|
|
printf("#! exit %i: resetting\n", n);
|
|
|
|
|
|
|
|
|
|
stdio_flush();
|
|
|
|
|
arm_reset();
|
|
|
|
|
while(1);
|
|
|
|
|
stdio_flush();
|
|
|
|
|
arm_reset();
|
|
|
|
|
while(1);
|
|
|
|
|
}
|
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
|
int _getpid(void)
|
|
|
|
|
{
|
|
|
|
|
return active_thread->pid;
|
|
|
|
|
return active_thread->pid;
|
|
|
|
|
}
|
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
|
int _kill_r(struct _reent *r, int pid, int sig)
|
|
|
|
|
{
|
|
|
|
|
/* not implemented */
|
|
|
|
|
r->_errno = ESRCH; // no such process
|
|
|
|
|
return -1;
|
|
|
|
|
/* not implemented */
|
|
|
|
|
r->_errno = ESRCH; // no such process
|
|
|
|
|
return -1;
|
|
|
|
|
}
|
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
|
void _init(void){}
|
|
|
|
|
|
Ludwig Ortmann
11 years ago