update can protocol
This commit is contained in:
@ -19,7 +19,7 @@
|
||||
//
|
||||
//-------------------------------------------------------------------------------------------------
|
||||
//
|
||||
// Description: TEC - Peltier Controller
|
||||
// Description: TEC - Peltier Controller Communication handler
|
||||
//
|
||||
//=================================================================================================
|
||||
|
||||
@ -64,10 +64,6 @@
|
||||
|
||||
#define EVENT_FLAGS_ALL ( EVENT_NEW_MESSAGE | EVENT_TIMER_UPDATE )
|
||||
|
||||
#define MESSAGE_TYPE_READ 0
|
||||
#define MESSAGE_TYPE_WRITE 1
|
||||
#define MESSAGE_TYPE_COMMAND 2
|
||||
|
||||
#define COMMAND_NONE 0
|
||||
#define COMMAND_ON 1
|
||||
#define COMMAND_OFF 2
|
||||
@ -226,13 +222,11 @@ PRIVATE VOID vTask( PVOID arg )
|
||||
|
||||
if( u32Flags & EVENT_NEW_MESSAGE ) {
|
||||
|
||||
// TODO: implement new protocol
|
||||
|
||||
CAND_Message stMessage;
|
||||
osMessageQueueGet( m_pstCANRxMsgQueueID, &stMessage, NULL, 0 );
|
||||
|
||||
U8 u8Register = stMessage.au8Data[0];
|
||||
U8 u8Typ = stMessage.au8Data[1];
|
||||
U8 u8Typ = stMessage.u8Typ;
|
||||
|
||||
if( u8Typ == MESSAGE_TYPE_READ ){
|
||||
VARH_UVariable uVariable = VARH_uGetVariableData(u8Register);
|
||||
@ -244,7 +238,7 @@ PRIVATE VOID vTask( PVOID arg )
|
||||
CAND_boSendMessage( au8Buffer, 6 );
|
||||
} else if( u8Typ == MESSAGE_TYPE_WRITE ){
|
||||
VARH_UVariable uData;
|
||||
UTIL_vMemCopy(&stMessage.au8Data[2], &uData, 4);
|
||||
UTIL_vMemCopy(&stMessage.au8Data[1], &uData, 4);
|
||||
|
||||
VARH_vSetVariableData(u8Register, uData);
|
||||
} else if( u8Typ == MESSAGE_TYPE_COMMAND ){
|
||||
@ -258,7 +252,7 @@ PRIVATE VOID vTask( PVOID arg )
|
||||
case COMMAND_OFF:
|
||||
PECO_Enable( FALSE );
|
||||
break;
|
||||
|
||||
// TODO: Implement watchdog
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
Reference in New Issue
Block a user