Slave controller for AEB and QA item
Diff: Controller_Slave.c
- Revision:
- 1:370626c9b451
- Parent:
- 0:88fb7562377b
diff -r 88fb7562377b -r 370626c9b451 Controller_Slave.c --- a/Controller_Slave.c Wed Jul 06 09:21:22 2016 +0000 +++ b/Controller_Slave.c Mon Jul 11 10:15:51 2016 +0000 @@ -7,12 +7,12 @@ * * Code generated for Simulink model 'Controller_Slave'. * - * Model version : 1.6 + * Model version : 1.7 * Simulink Coder version : 8.10 (R2016a) 10-Feb-2016 - * C/C++ source code generated on : Wed Jul 06 11:19:35 2016 + * C/C++ source code generated on : Sun Jul 10 15:19:51 2016 * * Target selection: ert.tlc - * Embedded hardware selection: NXP->Cortex-M4 + * Embedded hardware selection: ARM Compatible->ARM Cortex * Code generation objectives: Unspecified * Validation result: Not run */ @@ -23,11 +23,11 @@ #define Controller_S_IN_NO_ACTIVE_CHILD ((uint8_T)0U) #define Controller_Slave_IN_ACCELERATE ((uint8_T)1U) #define Controller_Slave_IN_AEB_ACTIVE ((uint8_T)1U) -#define Controller_Slave_IN_BRAKE ((uint8_T)2U) -#define Controller_Slave_IN_BRAKE_i ((uint8_T)1U) +#define Controller_Slave_IN_BRAKE ((uint8_T)1U) +#define Controller_Slave_IN_BRAKE_i ((uint8_T)2U) #define Controller_Slave_IN_ERR ((uint8_T)1U) -#define Controller_Slave_IN_IDLE ((uint8_T)3U) -#define Controller_Slave_IN_IDLE_b ((uint8_T)2U) +#define Controller_Slave_IN_IDLE ((uint8_T)2U) +#define Controller_Slave_IN_IDLE_b ((uint8_T)3U) #define Controller_Slave_IN_OK ((uint8_T)2U) #define Controller_Slave_IN_QA_ACTIVE ((uint8_T)2U) #define Controller_Slave_IN_READY ((uint8_T)3U) @@ -92,290 +92,6 @@ real_T K; /* During 'AEB_QA': '<S2>:35' */ - /* During 'APPLICATION_THREAD': '<S2>:32' */ - switch (Controller_Slave_DW->is_APPLICATION_THREAD) { - case Controller_Slave_IN_AEB_ACTIVE: - /* During 'AEB_ACTIVE': '<S2>:1' */ - /* '<S2>:26:1' sf_internal_predicateOutput = ... */ - /* '<S2>:26:1' En == false; */ - if (!Controller_Slave_DW->En) { - /* Transition: '<S2>:26' */ - /* Exit Internal 'AEB_ACTIVE': '<S2>:1' */ - Controller_Slave_DW->is_AEB_ACTIVE = Controller_S_IN_NO_ACTIVE_CHILD; - Controller_Slave_DW->is_APPLICATION_THREAD = Controller_Slave_IN_READY; - - /* Entry 'READY': '<S2>:21' */ - /* '<S2>:21:1' Brake = uint8(0); */ - *Controller_Slave_Y_BRAKE = 0U; - - /* '<S2>:21:1' Led_Blue = 0; */ - Controller_Slave_B->Led_Blue = 0.0; - - /* '<S2>:21:1' Led_Green = uint8(0); */ - *Controller_Slave_Y_LED_GREEN = 0U; - - /* '<S2>:21:4' Acc =uint8(0); */ - *Controller_Slave_Y_ACC = 0U; - } else { - /* Inport: '<Root>/QA_EN' incorporates: - * Inport: '<Root>/V' - */ - /* '<S2>:70:1' sf_internal_predicateOutput = ... */ - /* '<S2>:70:1' QA_En == true && V<30; */ - if (Controller_Slave_U_QA_EN && (Controller_Slave_U_V < 30.0)) { - /* Transition: '<S2>:70' */ - /* Exit Internal 'AEB_ACTIVE': '<S2>:1' */ - Controller_Slave_DW->is_AEB_ACTIVE = Controller_S_IN_NO_ACTIVE_CHILD; - Controller_Slave_DW->is_APPLICATION_THREAD = - Controller_Slave_IN_QA_ACTIVE; - - /* Entry 'QA_ACTIVE': '<S2>:69' */ - /* '<S2>:69:1' K = (V^2)/D; */ - /* Entry Internal 'QA_ACTIVE': '<S2>:69' */ - /* Transition: '<S2>:64' */ - Controller_Slave_DW->is_QA_ACTIVE = Controller_Slave_IN_IDLE; - - /* Entry 'IDLE': '<S2>:67' */ - /* '<S2>:67:1' Brake = uint8(0); */ - *Controller_Slave_Y_BRAKE = 0U; - - /* '<S2>:67:1' Led_Blue = 0; */ - Controller_Slave_B->Led_Blue = 0.0; - - /* '<S2>:67:1' Led_Green = uint8(0); */ - *Controller_Slave_Y_LED_GREEN = 0U; - - /* '<S2>:67:4' Acc = uint8(0); */ - *Controller_Slave_Y_ACC = 0U; - } else { - /* Inport: '<Root>/D_S' */ - /* '<S2>:1:1' K = (V^2)/D; */ - K = Controller_Slave_U_V * Controller_Slave_U_V / Controller_Slave_U_D_S; - switch (Controller_Slave_DW->is_AEB_ACTIVE) { - case Controller_Slave_IN_BRAKE_i: - /* During 'BRAKE': '<S2>:3' */ - /* '<S2>:10:1' sf_internal_predicateOutput = ... */ - /* '<S2>:10:1' K < 100; */ - if (K < 100.0) { - /* Transition: '<S2>:10' */ - Controller_Slave_DW->is_AEB_ACTIVE = Controller_Slave_IN_WARNING; - - /* Entry 'WARNING': '<S2>:5' */ - /* '<S2>:5:1' Brake = uint8(0); */ - *Controller_Slave_Y_BRAKE = 0U; - } - break; - - case Controller_Slave_IN_IDLE_b: - /* During 'IDLE': '<S2>:6' */ - /* '<S2>:12:1' sf_internal_predicateOutput = ... */ - /* '<S2>:12:1' K >= 70; */ - if (K >= 70.0) { - /* Transition: '<S2>:12' */ - Controller_Slave_DW->is_AEB_ACTIVE = Controller_Slave_IN_WARNING; - - /* Entry 'WARNING': '<S2>:5' */ - /* '<S2>:5:1' Brake = uint8(0); */ - *Controller_Slave_Y_BRAKE = 0U; - } - break; - - default: - /* During 'WARNING': '<S2>:5' */ - /* '<S2>:9:1' sf_internal_predicateOutput = ... */ - /* '<S2>:9:1' K >= 100; */ - if (K >= 100.0) { - /* Transition: '<S2>:9' */ - Controller_Slave_DW->is_AEB_ACTIVE = Controller_Slave_IN_BRAKE_i; - - /* Entry 'BRAKE': '<S2>:3' */ - /* '<S2>:3:1' Brake = uint8(1); */ - *Controller_Slave_Y_BRAKE = 1U; - - /* '<S2>:3:1' Led_Blue = 1; */ - Controller_Slave_B->Led_Blue = 1.0; - } else { - /* '<S2>:11:1' sf_internal_predicateOutput = ... */ - /* '<S2>:11:1' K < 70; */ - if (K < 70.0) { - /* Transition: '<S2>:11' */ - Controller_Slave_DW->is_AEB_ACTIVE = Controller_Slave_IN_IDLE_b; - - /* Entry 'IDLE': '<S2>:6' */ - /* '<S2>:6:1' Brake = uint8(0); */ - *Controller_Slave_Y_BRAKE = 0U; - - /* '<S2>:6:1' Led_Blue = 0; */ - Controller_Slave_B->Led_Blue = 0.0; - } else { - /* '<S2>:5:1' Led_Blue = (K-70)/30; */ - Controller_Slave_B->Led_Blue = (K - 70.0) / 30.0; - } - } - break; - } - } - } - break; - - case Controller_Slave_IN_QA_ACTIVE: - /* Inport: '<Root>/QA_EN' incorporates: - * Inport: '<Root>/V' - */ - /* During 'QA_ACTIVE': '<S2>:69' */ - /* '<S2>:71:1' sf_internal_predicateOutput = ... */ - /* '<S2>:71:1' QA_En ~= true || V>=30; */ - if ((!Controller_Slave_U_QA_EN) || (Controller_Slave_U_V >= 30.0)) { - /* Transition: '<S2>:71' */ - /* Exit Internal 'QA_ACTIVE': '<S2>:69' */ - Controller_Slave_DW->is_QA_ACTIVE = Controller_S_IN_NO_ACTIVE_CHILD; - Controller_Slave_DW->is_APPLICATION_THREAD = - Controller_Slave_IN_AEB_ACTIVE; - - /* Entry 'AEB_ACTIVE': '<S2>:1' */ - /* '<S2>:1:1' K = (V^2)/D; */ - /* Entry Internal 'AEB_ACTIVE': '<S2>:1' */ - /* Transition: '<S2>:51' */ - Controller_Slave_DW->is_AEB_ACTIVE = Controller_Slave_IN_IDLE_b; - - /* Entry 'IDLE': '<S2>:6' */ - /* '<S2>:6:1' Brake = uint8(0); */ - *Controller_Slave_Y_BRAKE = 0U; - - /* '<S2>:6:1' Led_Blue = 0; */ - Controller_Slave_B->Led_Blue = 0.0; - } else { - /* '<S2>:79:1' sf_internal_predicateOutput = ... */ - /* '<S2>:79:1' En == false; */ - if (!Controller_Slave_DW->En) { - /* Transition: '<S2>:79' */ - /* Exit Internal 'QA_ACTIVE': '<S2>:69' */ - Controller_Slave_DW->is_QA_ACTIVE = Controller_S_IN_NO_ACTIVE_CHILD; - Controller_Slave_DW->is_APPLICATION_THREAD = Controller_Slave_IN_READY; - - /* Entry 'READY': '<S2>:21' */ - /* '<S2>:21:1' Brake = uint8(0); */ - *Controller_Slave_Y_BRAKE = 0U; - - /* '<S2>:21:1' Led_Blue = 0; */ - Controller_Slave_B->Led_Blue = 0.0; - - /* '<S2>:21:1' Led_Green = uint8(0); */ - *Controller_Slave_Y_LED_GREEN = 0U; - - /* '<S2>:21:4' Acc =uint8(0); */ - *Controller_Slave_Y_ACC = 0U; - } else { - /* Inport: '<Root>/D_S' */ - /* '<S2>:69:1' K = (V^2)/D; */ - K = Controller_Slave_U_V * Controller_Slave_U_V / Controller_Slave_U_D_S; - switch (Controller_Slave_DW->is_QA_ACTIVE) { - case Controller_Slave_IN_ACCELERATE: - /* During 'ACCELERATE': '<S2>:68' */ - /* '<S2>:75:1' sf_internal_predicateOutput = ... */ - /* '<S2>:75:1' K >= 100; */ - if (K >= 100.0) { - /* Transition: '<S2>:75' */ - Controller_Slave_DW->is_QA_ACTIVE = Controller_Slave_IN_IDLE; - - /* Entry 'IDLE': '<S2>:67' */ - /* '<S2>:67:1' Brake = uint8(0); */ - *Controller_Slave_Y_BRAKE = 0U; - - /* '<S2>:67:1' Led_Blue = 0; */ - Controller_Slave_B->Led_Blue = 0.0; - - /* '<S2>:67:1' Led_Green = uint8(0); */ - *Controller_Slave_Y_LED_GREEN = 0U; - - /* '<S2>:67:4' Acc = uint8(0); */ - *Controller_Slave_Y_ACC = 0U; - } - break; - - case Controller_Slave_IN_BRAKE: - /* During 'BRAKE': '<S2>:65' */ - /* '<S2>:73:1' sf_internal_predicateOutput = ... */ - /* '<S2>:73:1' K <= 100; */ - if (K <= 100.0) { - /* Transition: '<S2>:73' */ - Controller_Slave_DW->is_QA_ACTIVE = Controller_Slave_IN_IDLE; - - /* Entry 'IDLE': '<S2>:67' */ - /* '<S2>:67:1' Brake = uint8(0); */ - *Controller_Slave_Y_BRAKE = 0U; - - /* '<S2>:67:1' Led_Blue = 0; */ - Controller_Slave_B->Led_Blue = 0.0; - - /* '<S2>:67:1' Led_Green = uint8(0); */ - *Controller_Slave_Y_LED_GREEN = 0U; - - /* '<S2>:67:4' Acc = uint8(0); */ - *Controller_Slave_Y_ACC = 0U; - } - break; - - default: - /* During 'IDLE': '<S2>:67' */ - /* '<S2>:72:1' sf_internal_predicateOutput = ... */ - /* '<S2>:72:1' K > 100; */ - if (K > 100.0) { - /* Transition: '<S2>:72' */ - Controller_Slave_DW->is_QA_ACTIVE = Controller_Slave_IN_BRAKE; - - /* Entry 'BRAKE': '<S2>:65' */ - /* '<S2>:65:1' Brake = uint8(1); */ - *Controller_Slave_Y_BRAKE = 1U; - - /* '<S2>:65:1' Led_Blue = 1; */ - Controller_Slave_B->Led_Blue = 1.0; - } else { - /* '<S2>:74:1' sf_internal_predicateOutput = ... */ - /* '<S2>:74:1' K < 100; */ - if (K < 100.0) { - /* Transition: '<S2>:74' */ - Controller_Slave_DW->is_QA_ACTIVE = Controller_Slave_IN_ACCELERATE; - - /* Entry 'ACCELERATE': '<S2>:68' */ - /* '<S2>:68:1' Led_Green = uint8(1); */ - *Controller_Slave_Y_LED_GREEN = 1U; - - /* '<S2>:68:1' Acc = uint8(1); */ - *Controller_Slave_Y_ACC = 1U; - } - } - break; - } - } - } - break; - - default: - /* During 'READY': '<S2>:21' */ - /* '<S2>:23:1' sf_internal_predicateOutput = ... */ - /* '<S2>:23:1' En == true; */ - if (Controller_Slave_DW->En) { - /* Transition: '<S2>:23' */ - Controller_Slave_DW->is_APPLICATION_THREAD = - Controller_Slave_IN_AEB_ACTIVE; - - /* Entry 'AEB_ACTIVE': '<S2>:1' */ - /* '<S2>:1:1' K = (V^2)/D; */ - /* Entry Internal 'AEB_ACTIVE': '<S2>:1' */ - /* Transition: '<S2>:51' */ - Controller_Slave_DW->is_AEB_ACTIVE = Controller_Slave_IN_IDLE_b; - - /* Entry 'IDLE': '<S2>:6' */ - /* '<S2>:6:1' Brake = uint8(0); */ - *Controller_Slave_Y_BRAKE = 0U; - - /* '<S2>:6:1' Led_Blue = 0; */ - Controller_Slave_B->Led_Blue = 0.0; - } - break; - } - /* During 'ERRORS_CHECK_THREAD': '<S2>:80' */ switch (Controller_Slave_DW->is_ERRORS_CHECK_THREAD) { case Controller_Slave_IN_ERR: @@ -459,6 +175,313 @@ *Controller_Slave_Y_SLAVE = 1U; break; } + + /* During 'APPLICATION_THREAD': '<S2>:97' */ + switch (Controller_Slave_DW->is_APPLICATION_THREAD) { + case Controller_Slave_IN_AEB_ACTIVE: + /* During 'AEB_ACTIVE': '<S2>:106' */ + /* '<S2>:100:1' sf_internal_predicateOutput = ... */ + /* '<S2>:100:1' En == false; */ + if (!Controller_Slave_DW->En) { + /* Transition: '<S2>:100' */ + /* Exit Internal 'AEB_ACTIVE': '<S2>:106' */ + Controller_Slave_DW->is_AEB_ACTIVE = Controller_S_IN_NO_ACTIVE_CHILD; + + /* Exit 'AEB_ACTIVE': '<S2>:106' */ + /* '<S2>:106:2' Brake = uint8(0); */ + /* '<S2>:106:3' Led_Blue = 0; */ + Controller_Slave_DW->is_APPLICATION_THREAD = Controller_Slave_IN_READY; + + /* Entry 'READY': '<S2>:115' */ + /* '<S2>:115:1' Brake = uint8(0); */ + *Controller_Slave_Y_BRAKE = 0U; + + /* '<S2>:115:1' Led_Blue = 0; */ + Controller_Slave_B->Led_Blue = 0.0; + + /* '<S2>:115:1' Led_Green = uint8(0); */ + *Controller_Slave_Y_LED_GREEN = 0U; + + /* '<S2>:115:4' Acc = uint8(0); */ + *Controller_Slave_Y_ACC = 0U; + } else { + /* Inport: '<Root>/QA_EN' incorporates: + * Inport: '<Root>/V' + */ + /* '<S2>:102:1' sf_internal_predicateOutput = ... */ + /* '<S2>:102:1' QA_En == true && V<30; */ + if (Controller_Slave_U_QA_EN && (Controller_Slave_U_V < 30.0)) { + /* Transition: '<S2>:102' */ + /* Exit Internal 'AEB_ACTIVE': '<S2>:106' */ + Controller_Slave_DW->is_AEB_ACTIVE = Controller_S_IN_NO_ACTIVE_CHILD; + + /* Exit 'AEB_ACTIVE': '<S2>:106' */ + /* '<S2>:106:2' Brake = uint8(0); */ + /* '<S2>:106:3' Led_Blue = 0; */ + Controller_Slave_DW->is_APPLICATION_THREAD = + Controller_Slave_IN_QA_ACTIVE; + + /* Entry 'QA_ACTIVE': '<S2>:118' */ + /* '<S2>:118:1' K = (V^2)/D; */ + /* Entry Internal 'QA_ACTIVE': '<S2>:118' */ + /* Transition: '<S2>:119' */ + Controller_Slave_DW->is_QA_ACTIVE = Controller_Slave_IN_IDLE_b; + + /* Entry 'IDLE': '<S2>:124' */ + /* '<S2>:124:1' Brake = uint8(0); */ + *Controller_Slave_Y_BRAKE = 0U; + + /* '<S2>:124:1' Led_Blue = 0; */ + Controller_Slave_B->Led_Blue = 0.0; + + /* '<S2>:124:1' Led_Green = uint8(0); */ + *Controller_Slave_Y_LED_GREEN = 0U; + + /* '<S2>:124:4' Acc = uint8(0); */ + *Controller_Slave_Y_ACC = 0U; + } else { + /* Inport: '<Root>/D_S' */ + /* '<S2>:106:1' K = (V^2)/D; */ + K = Controller_Slave_U_V * Controller_Slave_U_V / Controller_Slave_U_D_S; + switch (Controller_Slave_DW->is_AEB_ACTIVE) { + case Controller_Slave_IN_BRAKE: + /* During 'BRAKE': '<S2>:114' */ + /* '<S2>:111:1' sf_internal_predicateOutput = ... */ + /* '<S2>:111:1' K < 100; */ + if (K < 100.0) { + /* Transition: '<S2>:111' */ + Controller_Slave_DW->is_AEB_ACTIVE = Controller_Slave_IN_WARNING; + + /* Entry 'WARNING': '<S2>:113' */ + /* '<S2>:113:1' Brake = uint8(0); */ + *Controller_Slave_Y_BRAKE = 0U; + } + break; + + case Controller_Slave_IN_IDLE: + /* During 'IDLE': '<S2>:112' */ + /* '<S2>:108:1' sf_internal_predicateOutput = ... */ + /* '<S2>:108:1' K >= 70; */ + if (K >= 70.0) { + /* Transition: '<S2>:108' */ + Controller_Slave_DW->is_AEB_ACTIVE = Controller_Slave_IN_WARNING; + + /* Entry 'WARNING': '<S2>:113' */ + /* '<S2>:113:1' Brake = uint8(0); */ + *Controller_Slave_Y_BRAKE = 0U; + } + break; + + default: + /* During 'WARNING': '<S2>:113' */ + /* '<S2>:110:1' sf_internal_predicateOutput = ... */ + /* '<S2>:110:1' K >= 100; */ + if (K >= 100.0) { + /* Transition: '<S2>:110' */ + Controller_Slave_DW->is_AEB_ACTIVE = Controller_Slave_IN_BRAKE; + + /* Entry 'BRAKE': '<S2>:114' */ + /* '<S2>:114:1' Brake = uint8(1); */ + *Controller_Slave_Y_BRAKE = 1U; + + /* '<S2>:114:1' Led_Blue = 1; */ + Controller_Slave_B->Led_Blue = 1.0; + } else { + /* '<S2>:109:1' sf_internal_predicateOutput = ... */ + /* '<S2>:109:1' K < 70; */ + if (K < 70.0) { + /* Transition: '<S2>:109' */ + Controller_Slave_DW->is_AEB_ACTIVE = Controller_Slave_IN_IDLE; + + /* Entry 'IDLE': '<S2>:112' */ + /* '<S2>:112:1' Brake = uint8(0); */ + *Controller_Slave_Y_BRAKE = 0U; + + /* '<S2>:112:1' Led_Blue = 0; */ + Controller_Slave_B->Led_Blue = 0.0; + } else { + /* '<S2>:113:1' Led_Blue = (K-70)/30; */ + Controller_Slave_B->Led_Blue = (K - 70.0) / 30.0; + } + } + break; + } + } + } + break; + + case Controller_Slave_IN_QA_ACTIVE: + /* Inport: '<Root>/QA_EN' incorporates: + * Inport: '<Root>/V' + */ + /* During 'QA_ACTIVE': '<S2>:118' */ + /* '<S2>:103:1' sf_internal_predicateOutput = ... */ + /* '<S2>:103:1' QA_En ~= true || V>=30; */ + if ((!Controller_Slave_U_QA_EN) || (Controller_Slave_U_V >= 30.0)) { + /* Transition: '<S2>:103' */ + /* Exit Internal 'QA_ACTIVE': '<S2>:118' */ + Controller_Slave_DW->is_QA_ACTIVE = Controller_S_IN_NO_ACTIVE_CHILD; + + /* Exit 'QA_ACTIVE': '<S2>:118' */ + /* '<S2>:118:2' Brake = uint8(0); */ + /* '<S2>:118:3' Led_Blue = 0; */ + /* '<S2>:118:4' Led_Green = uint8(0); */ + *Controller_Slave_Y_LED_GREEN = 0U; + + /* '<S2>:118:5' Acc = uint8(0); */ + *Controller_Slave_Y_ACC = 0U; + Controller_Slave_DW->is_APPLICATION_THREAD = + Controller_Slave_IN_AEB_ACTIVE; + + /* Entry 'AEB_ACTIVE': '<S2>:106' */ + /* '<S2>:106:1' K = (V^2)/D; */ + /* Entry Internal 'AEB_ACTIVE': '<S2>:106' */ + /* Transition: '<S2>:107' */ + Controller_Slave_DW->is_AEB_ACTIVE = Controller_Slave_IN_IDLE; + + /* Entry 'IDLE': '<S2>:112' */ + /* '<S2>:112:1' Brake = uint8(0); */ + *Controller_Slave_Y_BRAKE = 0U; + + /* '<S2>:112:1' Led_Blue = 0; */ + Controller_Slave_B->Led_Blue = 0.0; + } else { + /* '<S2>:101:1' sf_internal_predicateOutput = ... */ + /* '<S2>:101:1' En == false; */ + if (!Controller_Slave_DW->En) { + /* Transition: '<S2>:101' */ + /* Exit Internal 'QA_ACTIVE': '<S2>:118' */ + Controller_Slave_DW->is_QA_ACTIVE = Controller_S_IN_NO_ACTIVE_CHILD; + + /* Exit 'QA_ACTIVE': '<S2>:118' */ + /* '<S2>:118:2' Brake = uint8(0); */ + /* '<S2>:118:3' Led_Blue = 0; */ + /* '<S2>:118:4' Led_Green = uint8(0); */ + /* '<S2>:118:5' Acc = uint8(0); */ + Controller_Slave_DW->is_APPLICATION_THREAD = Controller_Slave_IN_READY; + + /* Entry 'READY': '<S2>:115' */ + /* '<S2>:115:1' Brake = uint8(0); */ + *Controller_Slave_Y_BRAKE = 0U; + + /* '<S2>:115:1' Led_Blue = 0; */ + Controller_Slave_B->Led_Blue = 0.0; + + /* '<S2>:115:1' Led_Green = uint8(0); */ + *Controller_Slave_Y_LED_GREEN = 0U; + + /* '<S2>:115:4' Acc = uint8(0); */ + *Controller_Slave_Y_ACC = 0U; + } else { + /* Inport: '<Root>/D_S' */ + /* '<S2>:118:1' K = (V^2)/D; */ + K = Controller_Slave_U_V * Controller_Slave_U_V / Controller_Slave_U_D_S; + switch (Controller_Slave_DW->is_QA_ACTIVE) { + case Controller_Slave_IN_ACCELERATE: + /* During 'ACCELERATE': '<S2>:125' */ + /* '<S2>:120:1' sf_internal_predicateOutput = ... */ + /* '<S2>:120:1' K >= 100; */ + if (K >= 100.0) { + /* Transition: '<S2>:120' */ + Controller_Slave_DW->is_QA_ACTIVE = Controller_Slave_IN_IDLE_b; + + /* Entry 'IDLE': '<S2>:124' */ + /* '<S2>:124:1' Brake = uint8(0); */ + *Controller_Slave_Y_BRAKE = 0U; + + /* '<S2>:124:1' Led_Blue = 0; */ + Controller_Slave_B->Led_Blue = 0.0; + + /* '<S2>:124:1' Led_Green = uint8(0); */ + *Controller_Slave_Y_LED_GREEN = 0U; + + /* '<S2>:124:4' Acc = uint8(0); */ + *Controller_Slave_Y_ACC = 0U; + } + break; + + case Controller_Slave_IN_BRAKE_i: + /* During 'BRAKE': '<S2>:126' */ + /* '<S2>:122:1' sf_internal_predicateOutput = ... */ + /* '<S2>:122:1' K <= 100; */ + if (K <= 100.0) { + /* Transition: '<S2>:122' */ + Controller_Slave_DW->is_QA_ACTIVE = Controller_Slave_IN_IDLE_b; + + /* Entry 'IDLE': '<S2>:124' */ + /* '<S2>:124:1' Brake = uint8(0); */ + *Controller_Slave_Y_BRAKE = 0U; + + /* '<S2>:124:1' Led_Blue = 0; */ + Controller_Slave_B->Led_Blue = 0.0; + + /* '<S2>:124:1' Led_Green = uint8(0); */ + *Controller_Slave_Y_LED_GREEN = 0U; + + /* '<S2>:124:4' Acc = uint8(0); */ + *Controller_Slave_Y_ACC = 0U; + } + break; + + default: + /* During 'IDLE': '<S2>:124' */ + /* '<S2>:121:1' sf_internal_predicateOutput = ... */ + /* '<S2>:121:1' K > 100; */ + if (K > 100.0) { + /* Transition: '<S2>:121' */ + Controller_Slave_DW->is_QA_ACTIVE = Controller_Slave_IN_BRAKE_i; + + /* Entry 'BRAKE': '<S2>:126' */ + /* '<S2>:126:1' Brake = uint8(1); */ + *Controller_Slave_Y_BRAKE = 1U; + + /* '<S2>:126:1' Led_Blue = 1; */ + Controller_Slave_B->Led_Blue = 1.0; + } else { + /* '<S2>:123:1' sf_internal_predicateOutput = ... */ + /* '<S2>:123:1' K < 100; */ + if (K < 100.0) { + /* Transition: '<S2>:123' */ + Controller_Slave_DW->is_QA_ACTIVE = Controller_Slave_IN_ACCELERATE; + + /* Entry 'ACCELERATE': '<S2>:125' */ + /* '<S2>:125:1' Led_Green = uint8(1); */ + *Controller_Slave_Y_LED_GREEN = 1U; + + /* '<S2>:125:1' Acc = uint8(1); */ + *Controller_Slave_Y_ACC = 1U; + } + } + break; + } + } + } + break; + + default: + /* During 'READY': '<S2>:115' */ + /* '<S2>:99:1' sf_internal_predicateOutput = ... */ + /* '<S2>:99:1' En == true; */ + if (Controller_Slave_DW->En) { + /* Transition: '<S2>:99' */ + Controller_Slave_DW->is_APPLICATION_THREAD = + Controller_Slave_IN_AEB_ACTIVE; + + /* Entry 'AEB_ACTIVE': '<S2>:106' */ + /* '<S2>:106:1' K = (V^2)/D; */ + /* Entry Internal 'AEB_ACTIVE': '<S2>:106' */ + /* Transition: '<S2>:107' */ + Controller_Slave_DW->is_AEB_ACTIVE = Controller_Slave_IN_IDLE; + + /* Entry 'IDLE': '<S2>:112' */ + /* '<S2>:112:1' Brake = uint8(0); */ + *Controller_Slave_Y_BRAKE = 0U; + + /* '<S2>:112:1' Led_Blue = 0; */ + Controller_Slave_B->Led_Blue = 0.0; + } + break; + } } /* Model step function */ @@ -488,26 +511,6 @@ /* Entry Internal: Controller_Slave/AEB_QA */ /* Entry Internal 'AEB_QA': '<S2>:35' */ - /* Entry Internal 'APPLICATION_THREAD': '<S2>:32' */ - /* Transition: '<S2>:27' */ - Controller_Slave_DW->is_APPLICATION_THREAD = Controller_Slave_IN_READY; - - /* Outport: '<Root>/BRAKE' */ - /* Entry 'READY': '<S2>:21' */ - /* '<S2>:21:1' Brake = uint8(0); */ - *Controller_Slave_Y_BRAKE = 0U; - - /* '<S2>:21:1' Led_Blue = 0; */ - Controller_Slave_B->Led_Blue = 0.0; - - /* Outport: '<Root>/LED_GREEN' */ - /* '<S2>:21:1' Led_Green = uint8(0); */ - *Controller_Slave_Y_LED_GREEN = 0U; - - /* Outport: '<Root>/ACC' */ - /* '<S2>:21:4' Acc =uint8(0); */ - *Controller_Slave_Y_ACC = 0U; - /* Entry Internal 'ERRORS_CHECK_THREAD': '<S2>:80' */ /* Transition: '<S2>:81' */ Controller_Slave_DW->is_ERRORS_CHECK_THREAD = Controller_Slave_IN_OK; @@ -520,6 +523,26 @@ /* Outport: '<Root>/SLAVE' */ /* '<S2>:94:1' Slave = uint8(1); */ *Controller_Slave_Y_SLAVE = 1U; + + /* Entry Internal 'APPLICATION_THREAD': '<S2>:97' */ + /* Transition: '<S2>:98' */ + Controller_Slave_DW->is_APPLICATION_THREAD = Controller_Slave_IN_READY; + + /* Outport: '<Root>/BRAKE' */ + /* Entry 'READY': '<S2>:115' */ + /* '<S2>:115:1' Brake = uint8(0); */ + *Controller_Slave_Y_BRAKE = 0U; + + /* '<S2>:115:1' Led_Blue = 0; */ + Controller_Slave_B->Led_Blue = 0.0; + + /* Outport: '<Root>/LED_GREEN' */ + /* '<S2>:115:1' Led_Green = uint8(0); */ + *Controller_Slave_Y_LED_GREEN = 0U; + + /* Outport: '<Root>/ACC' */ + /* '<S2>:115:4' Acc = uint8(0); */ + *Controller_Slave_Y_ACC = 0U; } else { Controller_Slave_AEB_QA(&Memory, Controller_Slave_U_V, Controller_Slave_U_D_S, Controller_Slave_U_QA_EN, Controller_Slave_Y_BRAKE, @@ -701,6 +724,8 @@ *Controller_Slave_Y_LED_GREEN, uint8_T *Controller_Slave_Y_LED_BLUE, uint8_T *Controller_Slave_Y_SLAVE) { + P_Controller_Slave_T *Controller_Slave_P = ((P_Controller_Slave_T *) + Controller_Slave_M->ModelData.defaultParam); DW_Controller_Slave_T *Controller_Slave_DW = ((DW_Controller_Slave_T *) Controller_Slave_M->ModelData.dwork); B_Controller_Slave_T *Controller_Slave_B = ((B_Controller_Slave_T *) @@ -732,7 +757,7 @@ /* SystemInitialize for Atomic SubSystem: '<Root>/Controller_Slave' */ /* InitializeConditions for Memory: '<S1>/Memory' */ - Controller_Slave_DW->Memory_PreviousInput = 1U; + Controller_Slave_DW->Memory_PreviousInput = Controller_Slave_P->Memory_X0; /* SystemInitialize for Chart: '<S1>/AEB_QA' */ Controller_Slave_DW->is_APPLICATION_THREAD = Controller_S_IN_NO_ACTIVE_CHILD;