From 495cc1df494505378977995eeb76b05f20f0b235 Mon Sep 17 00:00:00 2001 From: Nicolas Schodet Date: Sun, 13 Jun 2010 17:49:42 +0200 Subject: import firmware from LEGO v1.29 --- AT91SAM7S256/Source/d_ioctrl.c | 63 +++--------------------------------------- 1 file changed, 4 insertions(+), 59 deletions(-) (limited to 'AT91SAM7S256/Source/d_ioctrl.c') diff --git a/AT91SAM7S256/Source/d_ioctrl.c b/AT91SAM7S256/Source/d_ioctrl.c index 7c414f6..2506172 100644 --- a/AT91SAM7S256/Source/d_ioctrl.c +++ b/AT91SAM7S256/Source/d_ioctrl.c @@ -1,13 +1,13 @@ // // Date init 14.12.2004 // -// Revision date $Date:: 16-05-06 9:50 $ +// Revision date $Date:: 5-12-07 15:23 $ // // Filename $Workfile:: d_ioctrl.c $ // -// Version $Revision:: 11 $ +// Version $Revision:: 2 $ // -// Archive $Archive:: /LMS2006/Sys01/Main/Firmware/Source/d_ioctrl.c $ +// Archive $Archive:: /LMS2006/Sys01/Main_V02/Firmware/Source/d_ioct $ // // Platform C // @@ -19,22 +19,10 @@ #include "d_ioctrl.h" #include "d_ioctrl.r" -/* Enum related to State */ -enum -{ - RX_I2C = 1, - TX_I2C = 2, - UNLOCK_I2C = 3, - WAIT_I2C = 4 -}; - - -static UBYTE volatile State; void dIOCtrlInit(void) { IOCTRLInit; - State = UNLOCK_I2C; } void dIOCtrlSetPower(UBYTE Power) @@ -49,52 +37,9 @@ void dIOCtrlSetPwm(UBYTE Pwm) void dIOCtrlTransfer(void) { - UBYTE B; - - CHECKTime(B); - if (B) - { - switch(State) - { - case TX_I2C: - { - FULLDataTx; - State = RX_I2C; - } - break; - case RX_I2C: - { - FULLDataRx; - State = TX_I2C; - } - break; - case UNLOCK_I2C: - { - UNLOCKTx; - State = WAIT_I2C; - } - break; - case WAIT_I2C: - { - - /* Intermediate state as unlock string is 47 */ - /* characters which is a little more than 1mS */ - State = TX_I2C; - } - break; - default: - { - UNLOCKTx; - State = WAIT_I2C; - } - break; - } - SETTime; - } + I2CTransfer; } - - void dIOCtrlExit(void) { IOCTRLExit; -- cgit v1.2.3