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/d_lowspeed.c | 77 ++++++++++++++++++++++++++++++++++++++++ 1 file changed, 77 insertions(+) create mode 100644 AT91SAM7S256/Source/d_lowspeed.c (limited to 'AT91SAM7S256/Source/d_lowspeed.c') diff --git a/AT91SAM7S256/Source/d_lowspeed.c b/AT91SAM7S256/Source/d_lowspeed.c new file mode 100644 index 0000000..e3b5ba8 --- /dev/null +++ b/AT91SAM7S256/Source/d_lowspeed.c @@ -0,0 +1,77 @@ +// +// Date init 14.12.2004 +// +// Revision date $Date:: 16-05-06 12:13 $ +// +// Filename $Workfile:: d_lowspeed.c $ +// +// Version $Revision:: 14 $ +// +// Archive $Archive:: /LMS2006/Sys01/Main/Firmware/Source/d_lowspeed $ +// +// Platform C +// + +#include "stdconst.h" +#include "m_sched.h" +#include "d_lowspeed.h" +#include "d_lowspeed.r" + + +void dLowSpeedInit(void) +{ + LOWSpeedTxInit; + LOWSpeedTimerInit; + //ENABLEDebugOutput; +} + +void dLowSpeedStartTimer(void) +{ + ENABLEPWMTimerForLowCom; +} + +void dLowSpeedStopTimer(void) +{ + DISABLEPWMTimerForLowCom; +} + +void dLowSpeedInitPins(UBYTE ChannelNumber) +{ + ENABLETxPins(ChannelNumber); +} + +UBYTE dLowSpeedSendData(UBYTE ChannelNumber, UBYTE *DataOutBuffer, UBYTE NumberOfTxByte) +{ + UBYTE Status; + + TxData(ChannelNumber, Status, DataOutBuffer, NumberOfTxByte); + return(Status); +} + +void dLowSpeedReceiveData(UBYTE ChannelNumber, UBYTE *DataInBuffer, UBYTE ByteToRx) +{ + RxData(ChannelNumber, DataInBuffer, ByteToRx); +} + +UBYTE dLowSpeedComTxStatus(UBYTE ChannelNumber) +{ + UBYTE Status; + + STATUSTxCom(ChannelNumber, Status) + + return(Status); +} + +UBYTE dLowSpeedComRxStatus(UBYTE ChannelNumber) +{ + UBYTE Status; + + STATUSRxCom(ChannelNumber, Status) + + return(Status); +} + +void dLowSpeedExit(void) +{ + LOWSpeedExit; +} -- cgit v1.2.3