c1_vehicles.c

多个无人机的群飞行仿真 多个无人机的群飞行仿真

      c1_c1_vehicles();
      _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_event_e18);
      _sfEvent_ = c1_r_previousEvent;
    }
  }
  if(*c1_e19() == 1.0) {
    {
      uint8_T c1_s_previousEvent;
      c1_s_previousEvent = _sfEvent_;
      _sfEvent_ = c1_event_e19;
      _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_event_e19);
      c1_c1_vehicles();
      _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_event_e19);
      _sfEvent_ = c1_s_previousEvent;
    }
  }
  if(*c1_e20() == 1.0) {
    {
      uint8_T c1_t_previousEvent;
      c1_t_previousEvent = _sfEvent_;
      _sfEvent_ = c1_event_e20;
      _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_event_e20);
      c1_c1_vehicles();
      _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_event_e20);
      _sfEvent_ = c1_t_previousEvent;
    }
  }
}

static void c1_c1_vehicles(void)
{
  _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG,0);
  if(chartInstance.c1_is_active_c1_vehicles == 0) {
    _SFD_CC_CALL(CHART_ENTER_ENTRY_FUNCTION_TAG,0);
    chartInstance.c1_is_active_c1_vehicles = 1;
    _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG,0);
    chartInstance.c1_is_active_uav1 = 1;
    _SFD_CS_CALL(STATE_ACTIVE_TAG,19);
    chartInstance.c1_tp_uav1 = 1;
    if(chartInstance.c1_is_active_uav1 != 0) {
      _SFD_CT_CALL(TRANSITION_ACTIVE_TAG,15);
      if(chartInstance.c1_is_uav1 != c1_IN_ac_avoid) {
        chartInstance.c1_is_uav1 = (uint8_T)c1_IN_ac_avoid;
        _SFD_CS_CALL(STATE_ACTIVE_TAG,20);
        chartInstance.c1_tp_ac_avoid = 1;
        chartInstance.c1_mode_count[0][0]++;
        _SFD_DATA_RANGE_CHECK(chartInstance.c1_mode_count[0][0], 0U);
      }
      chartInstance.c1_is_active_uav2 = 1;
      _SFD_CS_CALL(STATE_ACTIVE_TAG,24);
      chartInstance.c1_tp_uav2 = 1;
      if(chartInstance.c1_is_active_uav2 != 0) {
        _SFD_CT_CALL(TRANSITION_ACTIVE_TAG,3);
        if(chartInstance.c1_is_uav2 != c1_IN_ac_avoid) {
          chartInstance.c1_is_uav2 = (uint8_T)c1_IN_ac_avoid;
          _SFD_CS_CALL(STATE_ACTIVE_TAG,18);
          chartInstance.c1_b_tp_ac_avoid = 1;
          chartInstance.c1_mode_count[0][1]++;
          _SFD_DATA_RANGE_CHECK(chartInstance.c1_mode_count[0][1], 0U);
        }
        chartInstance.c1_is_active_uav3 = 1;
        _SFD_CS_CALL(STATE_ACTIVE_TAG,5);
        chartInstance.c1_tp_uav3 = 1;
        if(chartInstance.c1_is_active_uav3 != 0) {
          _SFD_CT_CALL(TRANSITION_ACTIVE_TAG,11);
          if(chartInstance.c1_is_uav3 != c1_IN_ac_avoid) {
            chartInstance.c1_is_uav3 = (uint8_T)c1_IN_ac_avoid;
            _SFD_CS_CALL(STATE_ACTIVE_TAG,12);
            chartInstance.c1_c_tp_ac_avoid = 1;
            chartInstance.c1_mode_count[0][2]++;
            _SFD_DATA_RANGE_CHECK(chartInstance.c1_mode_count[0][2], 0U);
          }
          chartInstance.c1_is_active_uav4 = 1;
          _SFD_CS_CALL(STATE_ACTIVE_TAG,23);
          chartInstance.c1_tp_uav4 = 1;
          if(chartInstance.c1_is_active_uav4 != 0) {
            _SFD_CT_CALL(TRANSITION_ACTIVE_TAG,21);
            if(chartInstance.c1_is_uav4 != c1_IN_ac_avoid) {
              chartInstance.c1_is_uav4 = (uint8_T)c1_IN_ac_avoid;
              _SFD_CS_CALL(STATE_ACTIVE_TAG,7);
              chartInstance.c1_d_tp_ac_avoid = 1;
              chartInstance.c1_mode_count[0][3]++;
              _SFD_DATA_RANGE_CHECK(chartInstance.c1_mode_count[0][3], 0U);
            }
            chartInstance.c1_is_active_uav5 = 1;
            _SFD_CS_CALL(STATE_ACTIVE_TAG,0);
            chartInstance.c1_tp_uav5 = 1;
            if(chartInstance.c1_is_active_uav5 != 0) {
              _SFD_CT_CALL(TRANSITION_ACTIVE_TAG,20);
              if(chartInstance.c1_is_uav5 != c1_IN_ac_avoid) {
                chartInstance.c1_is_uav5 = (uint8_T)c1_IN_ac_avoid;
                _SFD_CS_CALL(STATE_ACTIVE_TAG,4);
                chartInstance.c1_e_tp_ac_avoid = 1;
                chartInstance.c1_mode_count[0][4]++;
                _SFD_DATA_RANGE_CHECK(chartInstance.c1_mode_count[0][4], 0U);
              }
              chartInstance.c1_is_active_parse_events = 1;
              _SFD_CS_CALL(STATE_ACTIVE_TAG,6);
              chartInstance.c1_tp_parse_events = 1;
            }
          }
        }
      }
    }
  } else {
    c1_uav1();
    c1_uav2();
    c1_uav3();
    c1_uav4();
    c1_uav5();
    _SFD_CS_CALL(STATE_ENTER_DURING_FUNCTION_TAG,6);
    if(chartInstance.c1_is_active_parse_events != 0) {
      if(_sfEvent_ == c1_event_e1) {
        CV_STATE_EVAL(6,0,2);
        {
          uint8_T c1_previousEvent;
          c1_previousEvent = _sfEvent_;
          _sfEvent_ = c1_event_aa;
          _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_event_aa);
          c1_uav1();
          _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_event_aa);
          _sfEvent_ = c1_previousEvent;
        }
      } else {
        CV_STATE_EVAL(6,0,1);
      }
      if(_sfEvent_ == c1_event_e2) {
        CV_STATE_EVAL(6,1,2);
        {
          uint8_T c1_b_previousEvent;
          c1_b_previousEvent = _sfEvent_;
          _sfEvent_ = c1_event_oa;
          _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_event_oa);
          c1_uav1();
          _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_event_oa);
          _sfEvent_ = c1_b_previousEvent;
        }
      } else {
        CV_STATE_EVAL(6,1,1);
      }
      if(_sfEvent_ == c1_event_e3) {
        CV_STATE_EVAL(6,2,2);
        {
          uint8_T c1_c_previousEvent;
          c1_c_previousEvent = _sfEvent_;
          _sfEvent_ = c1_event_ta;
          _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_event_ta);
          c1_uav1();
          _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_event_ta);
          _sfEvent_ = c1_c_previousEvent;
        }
      } else {
        CV_STATE_EVAL(6,2,1);
      }
      if(_sfEvent_ == c1_event_e4) {
        CV_STATE_EVAL(6,3,2);
        {
          uint8_T c1_d_previousEvent;
          c1_d_previousEvent = _sfEvent_;
          _sfEvent_ = c1_event_fk;
          _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_event_fk);
          c1_uav1();
          _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_event_fk);
          _sfEvent_ = c1_d_previousEvent;
        }
      } else {
        CV_STATE_EVAL(6,3,1);
      }
      if(_sfEvent_ == c1_event_e5) {
        CV_STATE_EVAL(6,4,2);
        {
          uint8_T c1_e_previousEvent;
          c1_e_previousEvent = _sfEvent_;
          _sfEvent_ = c1_b_event_aa;
          _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_b_event_aa);
          c1_uav2();
          _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_b_event_aa);
          _sfEvent_ = c1_e_previousEvent;
        }
      } else {
        CV_STATE_EVAL(6,4,1);
      }
      if(_sfEvent_ == c1_event_e6) {
        CV_STATE_EVAL(6,5,2);
        {
          uint8_T c1_f_previousEvent;
          c1_f_previousEvent = _sfEvent_;
          _sfEvent_ = c1_b_event_oa;
          _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_b_event_oa);
          c1_uav2();
          _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_b_event_oa);
          _sfEvent_ = c1_f_previousEvent;
        }
      } else {
        CV_STATE_EVAL(6,5,1);
      }
      if(_sfEvent_ == c1_event_e7) {
        CV_STATE_EVAL(6,6,2);
        {
          uint8_T c1_g_previousEvent;
          c1_g_previousEvent = _sfEvent_;
          _sfEvent_ = c1_b_event_ta;
          _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_b_event_ta);
          c1_uav2();
          _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_b_event_ta);
          _sfEvent_ = c1_g_previousEvent;
        }
      } else {
        CV_STATE_EVAL(6,6,1);
      }
      if(_sfEvent_ == c1_event_e8) {
        CV_STATE_EVAL(6,7,2);
        {
          uint8_T c1_h_previousEvent;
          c1_h_previousEvent = _sfEvent_;
          _sfEvent_ = c1_b_event_fk;
          _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_b_event_fk);
          c1_uav2();
          _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_b_event_fk);
          _sfEvent_ = c1_h_previousEvent;
        }
      } else {
        CV_STATE_EVAL(6,7,1);
      }
      if(_sfEvent_ == c1_event_e9) {
        CV_STATE_EVAL(6,8,2);
        {
          uint8_T c1_i_previousEvent;
          c1_i_previousEvent = _sfEvent_;
          _sfEvent_ = c1_c_event_aa;
          _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_c_event_aa);
          c1_uav3();
          _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_c_event_aa);
          _sfEvent_ = c1_i_previousEvent;
        }
      } else {
        CV_STATE_EVAL(6,8,1);
      }
      if(_sfEvent_ == c1_event_e10) {
        CV_STATE_EVAL(6,9,2);
        {
          uint8_T c1_j_previousEvent;
          c1_j_previousEvent = _sfEvent_;
          _sfEvent_ = c1_c_event_oa;
          _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_c_event_oa);
          c1_uav3();
          _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_c_event_oa);
          _sfEvent_ = c1_j_previousEvent;
        }
      } else {
        CV_STATE_EVAL(6,9,1);
      }
      if(_sfEvent_ == c1_event_e11) {
        CV_STATE_EVAL(6,10,2);
        {
          uint8_T c1_k_previousEvent;
          c1_k_previousEvent = _sfEvent_;
          _sfEvent_ = c1_c_event_ta;
          _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_c_event_ta);
          c1_uav3();
          _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_c_event_ta);
          _sfEvent_ = c1_k_previousEvent;
        }
      } else {
        CV_STATE_EVAL(6,10,1);
      }
      if(_sfEvent_ == c1_event_e12) {
        CV_STATE_EVAL(6,11,2);
        {
          uint8_T c1_l_previousEvent;
          c1_l_previousEvent = _sfEvent_;
          _sfEvent_ = c1_c_event_fk;
          _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_c_event_fk);
          c1_uav3();
          _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_c_event_fk);
          _sfEvent_ = c1_l_previousEvent;
        }
      } else {
        CV_STATE_EVAL(6,11,1);
      }
      if(_sfEvent_ == c1_event_e13) {
        CV_STATE_EVAL(6,12,2);
        {
          uint8_T c1_m_previousEvent;
          c1_m_previousEvent = _sfEvent_;
          _sfEvent_ = c1_d_event_aa;
          _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_d_event_aa);
          c1_uav4();
          _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_d_event_aa);
          _sfEvent_ = c1_m_previousEvent;
        }
      } else {
        CV_STATE_EVAL(6,12,1);
      }
      if(_sfEvent_ == c1_event_e14) {
        CV_STATE_EVAL(6,13,2);
        {
          uint8_T c1_n_previousEvent;
          c1_n_previousEvent = _sfEvent_;
          _sfEvent_ = c1_d_event_oa;
          _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_d_event_oa);
          c1_uav4();
          _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_d_event_oa);
          _sfEvent_ = c1_n_previousEvent;
        }
      } else {
        CV_STATE_EVAL(6,13,1);
      }
      if(_sfEvent_ == c1_event_e15) {
        CV_STATE_EVAL(6,14,2);
        {
          uint8_T c1_o_previousEvent;
          c1_o_previousEvent = _sfEvent_;
          _sfEvent_ = c1_d_event_ta;
          _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_d_event_ta);
          c1_uav4();
          _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_d_event_ta);
          _sfEvent_ = c1_o_previousEvent;
        }
      } else {
        CV_STATE_EVAL(6,14,1);
      }
      if(_sfEvent_ == c1_event_e16) {
        CV_STATE_EVAL(6,15,2);
        {
          uint8_T c1_p_previousEvent;
          c1_p_previousEvent = _sfEvent_;
          _sfEvent_ = c1_d_event_fk;
          _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_d_event_fk);
          c1_uav4();
          _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_d_event_fk);
          _sfEvent_ = c1_p_previousEvent;
        }
      } else {
        CV_STATE_EVAL(6,15,1);
      }
      if(_sfEvent_ == c1_event_e17) {
        CV_STATE_EVAL(6,16,2);
        {
          uint8_T c1_q_previousEvent;
          c1_q_previousEvent = _sfEvent_;
          _sfEvent_ = c1_e_event_aa;
          _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_e_event_aa);
          c1_uav5();
          _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_e_event_aa);
          _sfEvent_ = c1_q_previousEvent;
        }
      } else {
        CV_STATE_EVAL(6,16,1);
      }
      if(_sfEvent_ == c1_event_e18) {
        CV_STATE_EVAL(6,17,2);
        {
          uint8_T c1_r_previousEvent;
          c1_r_previousEvent = _sfEvent_;
          _sfEvent_ = c1_e_event_oa;
          _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_e_event_oa);
          c1_uav5();
          _SFD_CE_CALL(EVENT_AFTER_BROADCAST_TAG,c1_e_event_oa);
          _sfEvent_ = c1_r_previousEvent;
        }
      } else {
        CV_STATE_EVAL(6,17,1);
      }
      if(_sfEvent_ == c1_event_e19) {
        CV_STATE_EVAL(6,18,2);
        {
          uint8_T c1_s_previousEvent;
          c1_s_previousEvent = _sfEvent_;
          _sfEvent_ = c1_e_event_ta;
          _SFD_CE_CALL(EVENT_ENTER_BROADCAST_FUNCTION_TAG,c1_e_event_ta);