update can protocol

This commit is contained in:
2022-06-21 11:34:45 +02:00
parent 2d99902346
commit 8521a34897
8 changed files with 43 additions and 47 deletions

View File

@ -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;
}