implemented PID Loop

2022-01-09 14:23:22 +01:00
parent ff5a05d32b
commit 26522970e7
8 changed files with 74 additions and 27 deletions
--- a/Core/Application/MAIN_MainApplication.c
+++ b/Core/Application/MAIN_MainApplication.c
@ -227,6 +227,8 @@ PRIVATE VOID vMainTask( PVOID arg )
 		
 		if( u32Flags & EVENT_NEW_MESSAGE ) {

+      // TODO: implement new protocol
+
 			CAND_Message stMessage;
      		osMessageQueueGet( m_pstCANRxMsgQueueID, &stMessage, NULL, 0 );
 			
@ -234,7 +236,7 @@ PRIVATE VOID vMainTask( PVOID arg )

 				S16 s16Voltage = stMessage.au8Data[0] << 8;
 				s16Voltage |= stMessage.au8Data[1];
-				PECO_boSetTemperature( s16Voltage );
+        VARH_vSetVariableData(VARH_eControlVoltage, s16Voltage);
 				
 			} else if(stMessage.u8Id == 0x13){

--- a/Core/Application/VARH_VariableHandler.h
+++ b/Core/Application/VARH_VariableHandler.h
@ -71,7 +71,7 @@ typedef enum

  VARH_ePID_kp,
  VARH_ePID_ki,
-  VARH_ePID_ki,
+  VARH_ePID_kd,
  VARH_ePID_Temp,
  VARH_ePID_Max,
  VARH_ePID_Min,