00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033
00034
00035
00036
00037
00038
00039
00040
00041 #ifdef __CYGWIN__
00042 #include <sys/features.h>
00043 #endif
00044
00045 #include <pthread.h>
00046 #include <stdio.h>
00047 #include <stdlib.h>
00048 #include <unistd.h>
00049 #include <signal.h>
00050 #include <getopt.h>
00051 #include <termios.h>
00052 #include <cfg/os.h>
00053
00054 #include <sys/types.h>
00055 #include <sys/event.h>
00056 #include <sys/device.h>
00057 #include <sys/osdebug.h>
00058 #include <sys/atom.h>
00059 #include <dev/irqreg.h>
00060 #include <dev/unix_devs.h>
00061
00062 extern void NutAppMain(void *arg) __attribute__ ((noreturn));
00063
00064 #ifndef NUT_THREAD_MAINSTACK
00065 #define NUT_THREAD_MAINSTACK 1024
00066 #endif
00067
00068 #ifndef NUT_THREAD_IDLESTACK
00069 #define NUT_THREAD_IDLESTACK 1024
00070 #endif
00071
00072
00073 #define MAX_IRQ_SLOTS 3
00074
00075
00076 int interrupts_pending[MAX_IRQ_SLOTS];
00077
00078
00079 sigset_t irq_signal;
00080
00081
00082 uint16_t int_disabled;
00083
00084
00085 int irq_current = 0;
00086 int irq_slot = 0;
00087 int irq_sent = 0;
00088
00089
00090 static pthread_t interrupt_thread;
00091
00092
00093 pthread_mutex_t pending_mutex;
00094 pthread_cond_t pending_cv;
00095
00096
00097 pthread_mutex_t irq_mutex;
00098 pthread_cond_t irq_cv;
00099
00100
00101 IRQ_HANDLER irq_handlers[IRQ_MAX];
00102
00103
00104 HANDLE *irq_eventqueues[IRQ_MAX];
00105
00106
00119 int NutRegisterIrqHandler(uint8_t irq, void (*handler) (void *), void *arg)
00120 {
00121 if (irq >= IRQ_MAX)
00122 return -1;
00123
00124 NutEnterCritical();
00125
00126 irq_handlers[irq].ir_arg = arg;
00127 irq_handlers[irq].ir_handler = handler;
00128
00129 NutExitCritical();
00130
00131 return 0;
00132 }
00133
00134
00147 void NutUnixIrqEventPostAsync(uint8_t irq, HANDLE * queue)
00148 {
00149 if (irq < IRQ_MAX)
00150 irq_eventqueues[irq] = queue;
00151 }
00152
00161 void NutUnixThreadYieldHook(void);
00162 void NutUnixThreadYieldHook()
00163 {
00164 uint8_t irq;
00165 for (irq = 0; irq < IRQ_MAX; irq++) {
00166 if (irq_eventqueues[irq] != 0) {
00167
00168 NutEventPostFromIrq(irq_eventqueues[irq]);
00169 irq_eventqueues[irq] = 0;
00170 }
00171 }
00172 }
00173
00174
00175
00176
00177
00178
00179 static void NutUnixControlC(int);
00180 static void NutUnixControlC(int signal)
00181 {
00182 printf("CTRL-C! Abort application.\n\r");
00183 tcsetattr(fileno(stdout), TCSANOW, &emulation_options.saved_termios);
00184 exit(0);
00185 }
00186
00187
00188
00189
00190
00191
00192
00193
00194
00195
00196
00197
00198
00199
00200
00201
00202
00203
00204
00205
00206 static void NutUnixInterruptScheduler(int);
00207 static void NutUnixInterruptScheduler(int signal)
00208 {
00209 int irq;
00210
00211
00212 pthread_sigmask(SIG_BLOCK, &irq_signal, 0);
00213
00214
00215 if (irq_current != irq_slot) {
00216 irq = interrupts_pending[irq_current];
00217 if (++irq_current >= MAX_IRQ_SLOTS)
00218 irq_current = 0;
00219 if (irq < IRQ_MAX) {
00220 if (irq_handlers[irq].ir_handler) {
00221 irq_handlers[irq].ir_handler(irq_handlers[irq].ir_arg);
00222 }
00223 }
00224 }
00225
00226 pthread_sigmask(SIG_UNBLOCK, &irq_signal, 0);
00227 }
00228
00229
00244 extern uint32_t nut_ticks;
00245 void NutUnixRaiseInterrupt(int);
00246 void NutUnixRaiseInterrupt(int irq)
00247 {
00248 int r;
00249
00250
00251
00252
00253 if ((irq_current == 0 && irq_slot != MAX_IRQ_SLOTS - 1) || (irq_current != 0 && irq_slot != irq_current - 1)) {
00254
00255 pthread_mutex_lock(&pending_mutex);
00256
00257 interrupts_pending[irq_slot] = irq;
00258 if (++irq_slot >= MAX_IRQ_SLOTS) {
00259 irq_slot = 0;
00260 }
00261 #if 0
00262 if( (nut_ticks % 1000) == 0 )
00263 printf( "%u\n", nut_ticks );
00264 #endif
00265 pthread_mutex_unlock(&pending_mutex);
00266
00267
00268 r = pthread_cond_signal(&pending_cv);
00269 }
00270 }
00271
00272
00295 void *NutInterruptEmulation(void *unused_arg)
00296 {
00297
00298 pthread_sigmask(SIG_BLOCK, &irq_signal, 0);
00299
00300 for (;;) {
00301 pthread_mutex_lock(&pending_mutex);
00302 while (irq_slot == irq_sent) {
00303
00304 pthread_cond_wait(&pending_cv, &pending_mutex);
00305 }
00306 pthread_mutex_unlock(&pending_mutex);
00307
00308
00309 if (irq_slot != irq_sent) {
00310 pthread_mutex_lock(&irq_mutex);
00311
00312 while (int_disabled == 1) {
00313 pthread_cond_wait(&irq_cv, &irq_mutex);
00314 }
00315
00316 kill(-getpgrp(), SIGUSR1);
00317 irq_sent = irq_slot;
00318 pthread_mutex_unlock(&irq_mutex);
00319 }
00320 }
00321 return NULL;
00322 }
00323
00324
00325
00326
00327
00328
00329 static void NutIRQInit(void);
00330 static void NutIRQInit()
00331 {
00332 int irq;
00333
00334
00335 int_disabled = 0;
00336
00337
00338 irq_current = 0;
00339 irq_slot = 0;
00340 irq_sent = 0;
00341
00342
00343 for (irq = 0; irq < IRQ_MAX; irq++)
00344 irq_eventqueues[irq] = 0;
00345
00346
00347 sigemptyset(&irq_signal);
00348 sigaddset(&irq_signal, SIGUSR1);
00349
00350
00351 signal(SIGUSR1, NutUnixInterruptScheduler);
00352 signal(SIGINT, NutUnixControlC);
00353
00354
00355 pthread_mutex_init(&irq_mutex, NULL);
00356 irq = pthread_cond_init(&irq_cv, NULL);
00357
00358 irq = pthread_mutex_init(&pending_mutex, NULL);
00359 irq = pthread_cond_init(&pending_cv, NULL);
00360
00361
00362 pthread_create(&interrupt_thread, NULL, NutInterruptEmulation, (void *) (void *) NULL);
00363 }
00364
00369
00376 THREAD(NutIdle, arg)
00377 {
00378
00379 NutTimerInit();
00380
00381
00382 NutThreadCreate("main", NutAppMain, 0, NUT_THREAD_MAINSTACK);
00383
00384
00385
00386
00387
00388
00389
00390 NutThreadSetPriority(254);
00391 for (;;) {
00392 NutThreadYield();
00393 NutThreadDestroy();
00394
00395
00396 }
00397 }
00398
00406 #undef main
00407
00408 #define PSEUDO_RAM_SIZE 999999
00409 uint8_t PSEUDO_RAM[PSEUDO_RAM_SIZE];
00410
00411 extern void NutThreadInit(void);
00412
00413 extern NUTFILE *NUT_freopen(CONST char *name, CONST char *mode, NUTFILE * stream);
00414 extern NUTFILE *__iob[];
00415
00416 int main(int argc, char *argv[])
00417 {
00418 tcgetattr(fileno(stdout), &emulation_options.saved_termios);
00419
00420
00421 emulation_options_parse(argc, argv);
00422
00423
00424
00425
00426 NutHeapAdd(PSEUDO_RAM, PSEUDO_RAM_SIZE);
00427
00428
00429 NutLoadConfig();
00430
00431
00432
00433
00434
00435
00436
00437
00438
00439
00440
00441
00442
00443
00444
00445 NutIRQInit();
00446
00447
00448
00449
00450 NutThreadInit();
00451
00452
00453
00454
00455 NutThreadCreate("idle", NutIdle, 0, NUT_THREAD_IDLESTACK);
00456
00457 return 0;
00458 }
00459