From ba78bd9ba834260d035a9830726afc34fdad2a15 Mon Sep 17 00:00:00 2001 From: Nicolas Schodet Date: Sun, 18 Oct 2009 23:32:54 +0200 Subject: import firmware from LEGO v1.05 --- AT91SAM7S256/Source/m_sched.c | 94 +++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 94 insertions(+) create mode 100644 AT91SAM7S256/Source/m_sched.c (limited to 'AT91SAM7S256/Source/m_sched.c') diff --git a/AT91SAM7S256/Source/m_sched.c b/AT91SAM7S256/Source/m_sched.c new file mode 100644 index 0000000..bc394a5 --- /dev/null +++ b/AT91SAM7S256/Source/m_sched.c @@ -0,0 +1,94 @@ +// +// Date init 14.12.2004 +// +// Revision date $Date:: 16-05-06 10:15 $ +// +// Filename $Workfile:: m_sched.c $ +// +// Version $Revision:: 14 $ +// +// Archive $Archive:: /LMS2006/Sys01/Main/Firmware/Source/m_sched.c $ +// +// Platform C +// + + +#define INCLUDE_OS + +#define MODULEHEADERS 32 + +#include "stdconst.h" +#include "modules.h" +#include "m_sched.h" + +#include "c_comm.h" +#include "c_input.h" +#include "c_button.h" +#include "c_loader.h" +#include "c_sound.h" +#include "c_display.h" +#include "c_lowspeed.h" +#include "c_output.h" +#include "c_cmd.h" +#include "c_cmd.iom" +#include "c_ioctrl.h" +#include "c_ui.h" + + +static const HEADER* pModuleHeaders[MODULEHEADERS] = +{ + &cComm, + &cInput, + &cButton, + &cDisplay, + &cLoader, + &cLowSpeed, + &cOutput, + &cSound, + &cIOCtrl, + &cCmd, + &cUi, + 0 +}; + + +void mSchedInit(void) +{ + UWORD Tmp; + + Tmp = 0; + while(pModuleHeaders[Tmp]) + { + (*pModuleHeaders[Tmp]).cInit((void*) pModuleHeaders); + Tmp++; + } +} + + +UBYTE mSchedCtrl(void) +{ + UWORD Tmp; + + Tmp = 0; + while(pModuleHeaders[Tmp]) + { + (*pModuleHeaders[Tmp]).cCtrl(); + Tmp++; + } + + return(((IOMAPCMD*)(pModuleHeaders[ENTRY_CMD]->pIOMap))->Awake); +} + + +void mSchedExit(void) +{ + UWORD Tmp; + + Tmp = 0; + while(pModuleHeaders[Tmp]) + { + (*pModuleHeaders[Tmp]).cExit(); + Tmp++; + } +} + -- cgit v1.2.3