gitextract_fam4honr/ ├── .SimulinkProject/ │ ├── Extensions.type.Root/ │ │ └── Information.type.Extension.xml │ ├── Project.xml │ ├── ProjectData.type.Info.xml │ ├── Root.type.Categories/ │ │ ├── FileClassCategory.type.Category/ │ │ │ ├── artifact.type.Label.xml │ │ │ ├── convenience.type.Label.xml │ │ │ ├── derived.type.Label.xml │ │ │ ├── design.type.Label.xml │ │ │ ├── none.type.Label.xml │ │ │ ├── other.type.Label.xml │ │ │ └── test.type.Label.xml │ │ └── FileClassCategory.type.Category.xml │ ├── Root.type.EntryPoints/ │ │ └── 07f7c9cf-7923-4bb8-a618-01eed93d031e.type.EntryPoint.xml │ ├── Root.type.Files/ │ │ ├── .gitignore.type.File.xml │ │ ├── FMT_Model_Init.m.type.File.xml │ │ ├── LICENSE.type.File.xml │ │ ├── README.md.type.File.xml │ │ ├── bus.type.File/ │ │ │ ├── 1.type.DIR_SIGNIFIER.xml │ │ │ ├── Barometer_Bus.m.type.File.xml │ │ │ ├── Control_Out_Bus.m.type.File.xml │ │ │ ├── Extended_States_Bus.m.type.File.xml │ │ │ ├── FMS_Out_Bus.m.type.File.xml │ │ │ ├── GCS_Cmd_Bus.m.type.File.xml │ │ │ ├── GPS_uBlox_Bus.m.type.File.xml │ │ │ ├── IMU_Bus.m.type.File.xml │ │ │ ├── INS_Out_Bus.m.type.File.xml │ │ │ ├── MAG_Bus.m.type.File.xml │ │ │ ├── Optical_Flow_Bus.m.type.File.xml │ │ │ ├── Pilot_Cmd_Bus.m.type.File.xml │ │ │ ├── Plant_States_Bus.m.type.File.xml │ │ │ ├── Sonar_Bus.m.type.File.xml │ │ │ ├── StatesBus.m.type.File.xml │ │ │ ├── enum.type.File/ │ │ │ │ ├── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── ControlMode.m.type.File.xml │ │ │ │ ├── FMS_Cmd.m.type.File.xml │ │ │ │ └── VehicleStatus.m.type.File.xml │ │ │ ├── enum.type.File.xml │ │ │ └── mavlink_fmt_pilot_cmd_t.m.type.File.xml │ │ ├── bus.type.File.xml │ │ ├── lib.type.File/ │ │ │ ├── 1.type.DIR_SIGNIFIER.xml │ │ │ ├── FMT_Model_Lib.slx.type.File.xml │ │ │ ├── sl_customization.m.type.File.xml │ │ │ └── slblocks.m.type.File.xml │ │ ├── lib.type.File.xml │ │ ├── model.type.File/ │ │ │ ├── 1.type.DIR_SIGNIFIER.xml │ │ │ ├── Controller.type.File/ │ │ │ │ ├── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── ADRC-Controller.type.File/ │ │ │ │ │ └── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── ADRC-Controller.type.File.xml │ │ │ │ ├── Boat-Controller.type.File/ │ │ │ │ │ └── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── Boat-Controller.type.File.xml │ │ │ │ ├── Car-Controller.type.File/ │ │ │ │ │ └── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── Car-Controller.type.File.xml │ │ │ │ ├── FW-Controller.type.File/ │ │ │ │ │ └── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── FW-Controller.type.File.xml │ │ │ │ ├── MC-Controller.type.File/ │ │ │ │ │ └── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── MC-Controller.type.File.xml │ │ │ │ ├── Submarine-Controller.type.File/ │ │ │ │ │ └── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── Submarine-Controller.type.File.xml │ │ │ │ ├── control_default_config.mat.type.File.xml │ │ │ │ └── control_init.m.type.File.xml │ │ │ ├── Controller.type.File.xml │ │ │ ├── FMS.type.File/ │ │ │ │ ├── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── Boat-FMS.type.File/ │ │ │ │ │ └── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── Boat-FMS.type.File.xml │ │ │ │ ├── Car-FMS.type.File/ │ │ │ │ │ └── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── Car-FMS.type.File.xml │ │ │ │ ├── FW-FMS.type.File/ │ │ │ │ │ └── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── FW-FMS.type.File.xml │ │ │ │ ├── MC-FMS.type.File/ │ │ │ │ │ └── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── MC-FMS.type.File.xml │ │ │ │ ├── Submarine-FMS.type.File/ │ │ │ │ │ └── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── Submarine-FMS.type.File.xml │ │ │ │ ├── fms_default_config.mat.type.File.xml │ │ │ │ └── fms_init.m.type.File.xml │ │ │ ├── FMS.type.File.xml │ │ │ ├── INS.type.File/ │ │ │ │ ├── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── CF-INS.type.File/ │ │ │ │ │ └── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── CF-INS.type.File.xml │ │ │ │ ├── ins_default_config.mat.type.File.xml │ │ │ │ └── ins_init.m.type.File.xml │ │ │ ├── INS.type.File.xml │ │ │ ├── Plant.type.File/ │ │ │ │ ├── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── FW-Plant.type.File/ │ │ │ │ │ └── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── FW-Plant.type.File.xml │ │ │ │ ├── MC-Plant.type.File/ │ │ │ │ │ └── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── MC-Plant.type.File.xml │ │ │ │ ├── plant_default_config.mat.type.File.xml │ │ │ │ └── plant_init.m.type.File.xml │ │ │ └── Plant.type.File.xml │ │ ├── model.type.File.xml │ │ ├── script.type.File/ │ │ │ ├── 1.type.DIR_SIGNIFIER.xml │ │ │ ├── CRL.type.File/ │ │ │ │ ├── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── crl_sin_cos_cmsis.m.type.File.xml │ │ │ │ ├── register_crl.m.type.File.xml │ │ │ │ └── rtwTargetInfo.m.type.File.xml │ │ │ ├── CRL.type.File.xml │ │ │ ├── analyze.type.File/ │ │ │ │ ├── 1.type.DIR_SIGNIFIER.xml │ │ │ │ └── compareModelOut.m.type.File.xml │ │ │ ├── analyze.type.File.xml │ │ │ ├── colorAxes.m.type.File.xml │ │ │ └── load_bus.m.type.File.xml │ │ ├── script.type.File.xml │ │ ├── simulation.type.File/ │ │ │ ├── 1.type.DIR_SIGNIFIER.xml │ │ │ ├── MILSIM.slx.type.File.xml │ │ │ ├── OpenLoopSIM.slx.type.File.xml │ │ │ ├── Visualization.type.File/ │ │ │ │ ├── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── LICENSE.md.type.File.xml │ │ │ │ ├── MWAerial.png.type.File.xml │ │ │ │ ├── asbQuadcopterAH1-4.wrl.type.File.xml │ │ │ │ ├── asbQuadcopterAH3.wrl.type.File.xml │ │ │ │ ├── asbQuadcopterAHBase.wrl.type.File.xml │ │ │ │ ├── asbQuadcopterBladeCCW.wrl.type.File.xml │ │ │ │ ├── asbQuadcopterBladeCW.wrl.type.File.xml │ │ │ │ ├── asbQuadcopterBody.wrl.type.File.xml │ │ │ │ ├── asbQuadcopterTrajectory.wrl.type.File.xml │ │ │ │ ├── asbQuadcopterWorld.wrl.type.File.xml │ │ │ │ ├── asbWaypointMarker.wrl.type.File.xml │ │ │ │ ├── asb_vrmfunc.m.type.File.xml │ │ │ │ ├── texture.type.File/ │ │ │ │ │ ├── 1.type.DIR_SIGNIFIER.xml │ │ │ │ │ ├── AH1_Portal-1.jpg.type.File.xml │ │ │ │ │ ├── AH1_Portal-2.jpg.type.File.xml │ │ │ │ │ ├── AH3_Portal.jpg.type.File.xml │ │ │ │ │ ├── AH4_Portal-1.jpg.type.File.xml │ │ │ │ │ ├── AH4window-1.jpg.type.File.xml │ │ │ │ │ ├── AH4window-2.jpg.type.File.xml │ │ │ │ │ ├── Glass_Arc_1.jpg.type.File.xml │ │ │ │ │ ├── MW_logo_transp.gif.type.File.xml │ │ │ │ │ ├── Window_Bricks_1.jpg.type.File.xml │ │ │ │ │ └── Window_Bricks_2.jpg.type.File.xml │ │ │ │ └── texture.type.File.xml │ │ │ ├── Visualization.type.File.xml │ │ │ ├── mavlink.type.File/ │ │ │ │ ├── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── sfun_decode_mavlink.h.type.File.xml │ │ │ │ ├── sfun_decode_mavlink.mexw64.type.File.xml │ │ │ │ └── sfun_mavlink_msg_fmt_pilot_cmd.h.type.File.xml │ │ │ └── mavlink.type.File.xml │ │ ├── simulation.type.File.xml │ │ ├── utils.type.File/ │ │ │ ├── 1.type.DIR_SIGNIFIER.xml │ │ │ ├── log_parser.type.File/ │ │ │ │ ├── 1.type.DIR_SIGNIFIER.xml │ │ │ │ ├── functions.type.File/ │ │ │ │ │ ├── 1.type.DIR_SIGNIFIER.xml │ │ │ │ │ ├── get_param_val.m.type.File.xml │ │ │ │ │ └── mlog_parser.m.type.File.xml │ │ │ │ ├── functions.type.File.xml │ │ │ │ ├── load_parameter.m.type.File.xml │ │ │ │ └── parse_mlog.m.type.File.xml │ │ │ └── log_parser.type.File.xml │ │ └── utils.type.File.xml │ ├── Root.type.ProjectPath/ │ │ ├── 0c347754-5981-4ea7-82bb-173c8773daaf.type.Reference.xml │ │ ├── 0f489e38-41df-47f5-812c-00cfc2846eb6.type.Reference.xml │ │ ├── 1dbe651e-f2bb-4d91-a8f8-eadbd30f57a0.type.Reference.xml │ │ ├── 1ddce3de-8cba-4f71-bd8c-3a4afccd1f08.type.Reference.xml │ │ ├── 2ca2dbcc-4fac-457b-820a-668e2c6cbe20.type.Reference.xml │ │ ├── 5fd30c5a-d4fd-455d-a9de-60129a03181a.type.Reference.xml │ │ ├── 6a9e2662-afdc-4ec6-99bf-6f4fbf72353f.type.Reference.xml │ │ ├── 7ca80432-3dbd-4e05-8e1e-3ae9768ae289.type.Reference.xml │ │ ├── 869590ad-497a-46d2-9ec4-d333896d23ef.type.Reference.xml │ │ ├── 99354230-8bbb-4ee3-8562-094734878c32.type.Reference.xml │ │ ├── a292cf92-9a65-403d-8e2d-b84be5cad72a.type.Reference.xml │ │ ├── a7ea2a05-26d2-4c60-82fd-3740f5afeb58.type.Reference.xml │ │ ├── a81eefd0-662d-4d85-a6ac-121ba82957fb.type.Reference.xml │ │ ├── baa073ec-16e2-4100-9e57-723c8f0e8fac.type.Reference.xml │ │ ├── bc6d66ea-ba3f-46a2-9349-a54d976d7124.type.Reference.xml │ │ ├── bdc9dcd2-b576-4443-aa00-1c47487695cc.type.Reference.xml │ │ ├── bfcac476-5782-4aa0-9b87-3b50a09d2984.type.Reference.xml │ │ ├── cdff36be-69a0-4833-8b5d-723151cb829f.type.Reference.xml │ │ ├── cf7750e2-8258-4245-81e4-be1cfce67166.type.Reference.xml │ │ ├── d3320b4c-0587-4293-b36c-751d35baa968.type.Reference.xml │ │ ├── d79031df-4af2-4f90-8e01-534c0400f948.type.Reference.xml │ │ ├── dc2241db-f9c0-41fb-a73e-bc4cb23fc23c.type.Reference.xml │ │ └── eadae34c-eb36-4ee2-b4a0-8f083edfa93e.type.Reference.xml │ └── uuid-17be4f40-b842-4154-9bf4-9ffcae07a6ca.xml ├── .gitignore ├── FMT_Model.prj ├── FMT_Model_Init.m ├── LICENSE ├── README.md ├── bus/ │ ├── AirSpeed_Bus.m │ ├── Auto_Cmd_Bus.m │ ├── Barometer_Bus.m │ ├── Commander_In_Bus.m │ ├── Control_Out_Bus.m │ ├── Environment_Info_Bus.m │ ├── Extended_States_Bus.m │ ├── External_Pos_Bus.m │ ├── FMS_Out_Bus.m │ ├── GCS_Cmd_Bus.m │ ├── GPS_uBlox_Bus.m │ ├── IMU_Bus.m │ ├── INS_Out_Bus.m │ ├── MAG_Bus.m │ ├── Mission_Data.m │ ├── Optical_Flow_Bus.m │ ├── Pilot_Cmd_Bus.m │ ├── Plant_States_Bus.m │ ├── Rangefinder_Bus.m │ ├── StatesBus.m │ ├── States_Init_Bus.m │ ├── enum/ │ │ ├── ControlMode.m │ │ ├── FMS_Cmd.m │ │ ├── FMS_Error.m │ │ ├── MotionState.m │ │ ├── NAV_Cmd.m │ │ ├── PilotMode.m │ │ ├── VTOLMode.m │ │ ├── VTOLState.m │ │ ├── VehicleState.m │ │ └── VehicleStatus.m │ ├── mavlink_fmt_environment_info_t.m │ ├── mavlink_fmt_pilot_cmd_t.m │ ├── mavlink_hil_actuator_controls_t.m │ └── mavlink_hil_state_t.m ├── lib/ │ ├── FMT_Model_Lib.slx │ ├── sl_customization.m │ └── slblocks.m ├── model/ │ ├── Controller/ │ │ ├── ADRC-Controller/ │ │ │ ├── Controller.slx │ │ │ ├── LICENSE │ │ │ ├── README.md │ │ │ └── controller_model_init.m │ │ ├── Boat-Controller/ │ │ │ ├── Controller.slx │ │ │ ├── LICENSE │ │ │ ├── README.md │ │ │ └── controller_model_init.m │ │ ├── Car-Controller/ │ │ │ ├── Controller.slx │ │ │ ├── LICENSE │ │ │ ├── README.md │ │ │ └── controller_model_init.m │ │ ├── FW-Controller/ │ │ │ ├── Controller.slx │ │ │ ├── LICENSE │ │ │ ├── README.md │ │ │ └── controller_model_init.m │ │ ├── MC-Controller/ │ │ │ ├── Controller.slx │ │ │ ├── LICENSE │ │ │ ├── README.md │ │ │ └── controller_model_init.m │ │ ├── Submarine-Controller/ │ │ │ ├── Controller.slx │ │ │ ├── LICENSE │ │ │ ├── README.md │ │ │ └── controller_model_init.m │ │ ├── VTOL-Controller/ │ │ │ ├── Controller.slx │ │ │ ├── LICENSE │ │ │ ├── README.md │ │ │ └── controller_model_init.m │ │ ├── control_default_config.mat │ │ └── control_init.m │ ├── FMS/ │ │ ├── Boat-FMS/ │ │ │ ├── FMS.slx │ │ │ ├── LICENSE │ │ │ ├── README.md │ │ │ └── fms_model_init.m │ │ ├── Car-FMS/ │ │ │ ├── FMS.slx │ │ │ ├── LICENSE │ │ │ ├── README.md │ │ │ └── fms_model_init.m │ │ ├── FW-FMS/ │ │ │ ├── FMS.slx │ │ │ ├── LICENSE │ │ │ ├── README.md │ │ │ └── fms_model_init.m │ │ ├── MC-FMS/ │ │ │ ├── FMS.slx │ │ │ ├── LICENSE │ │ │ ├── README.md │ │ │ └── fms_model_init.m │ │ ├── Submarine-FMS/ │ │ │ ├── FMS.slx │ │ │ ├── LICENSE │ │ │ ├── README.md │ │ │ └── fms_model_init.m │ │ ├── VTOL-FMS/ │ │ │ ├── FMS.slx │ │ │ ├── LICENSE │ │ │ ├── README.md │ │ │ └── fms_model_init.m │ │ ├── fms_default_config.mat │ │ └── fms_init.m │ ├── INS/ │ │ ├── CF-INS/ │ │ │ ├── INS.slx │ │ │ ├── LICENSE │ │ │ ├── README.md │ │ │ ├── ins_model_init.m │ │ │ └── wmmgrid_2021.mat │ │ ├── ins_default_config.mat │ │ └── ins_init.m │ └── Plant/ │ ├── Boat-Plant/ │ │ ├── LICENSE │ │ ├── Plant.slx │ │ ├── README.md │ │ ├── plant_model_init.m │ │ ├── sensor_model_init.m │ │ └── wmmgrid_2021.mat │ ├── FW-Plant/ │ │ ├── LICENSE │ │ ├── Plant.slx │ │ ├── README.md │ │ ├── acdata.mat │ │ ├── aero_data.mat │ │ ├── ap_ini.mat │ │ ├── plant_model_init.m │ │ ├── sensor_model_init.m │ │ └── wmmgrid_2021.mat │ ├── MC-Plant/ │ │ ├── LICENSE │ │ ├── Plant.slx │ │ ├── README.md │ │ ├── plant_model_init.m │ │ ├── sensor_model_init.m │ │ └── wmmgrid_2021.mat │ ├── VTOL-Plant/ │ │ ├── LICENSE │ │ ├── Plant.slx │ │ ├── README.md │ │ ├── acdata.mat │ │ ├── aero_data.mat │ │ ├── ap_ini.mat │ │ ├── plant_model_init.m │ │ ├── sensor_model_init.m │ │ └── wmmgrid_2021.mat │ ├── plant_default_config.mat │ └── plant_init.m ├── script/ │ ├── CRL/ │ │ ├── crl_sin_cos_cmsis.m │ │ ├── register_crl.m │ │ └── rtwTargetInfo.m │ ├── analyze/ │ │ ├── compareModelOut.m │ │ ├── plotControlResult.m │ │ └── plotINSResult.m │ ├── colorAxes.m │ ├── findLogicalArea.m │ └── load_bus.m ├── simulation/ │ ├── DataSIM.slx │ ├── MILSIM.slx │ ├── Visualization/ │ │ ├── LICENSE.md │ │ ├── asbQuadcopterAH1-4.wrl │ │ ├── asbQuadcopterAH3.wrl │ │ ├── asbQuadcopterAHBase.wrl │ │ ├── asbQuadcopterBladeCCW.wrl │ │ ├── asbQuadcopterBladeCW.wrl │ │ ├── asbQuadcopterBody.wrl │ │ ├── asbQuadcopterTrajectory.wrl │ │ ├── asbQuadcopterWorld.wrl │ │ ├── asbWaypointMarker.wrl │ │ └── asb_vrmfunc.m │ └── mavlink/ │ ├── sfun_decode_mavlink.cpp │ ├── sfun_decode_mavlink.h │ ├── sfun_decode_mavlink.mexa64 │ ├── sfun_decode_mavlink.mexw64 │ ├── sfun_encode_msg_fmt_environment_info.cpp │ ├── sfun_encode_msg_fmt_environment_info.mexw64 │ ├── sfun_encode_msg_hil_actuator_controls.cpp │ ├── sfun_encode_msg_hil_actuator_controls.mexw64 │ ├── sfun_encode_msg_hil_state.cpp │ ├── sfun_encode_msg_hil_state.mexw64 │ ├── sfun_mavlink_msg_fmt_environment_info.h │ ├── sfun_mavlink_msg_fmt_pilot_cmd.h │ ├── sfun_mavlink_msg_hil_actuator_controls.h │ └── sfun_mavlink_msg_hil_state.h └── utils/ ├── log_parser/ │ ├── functions/ │ │ ├── get_param_val.m │ │ ├── load_parameter.m │ │ ├── mission_data_preprocess.m │ │ └── mlog_parser.m │ └── parse_mlog.m └── wmm/ └── gen_wmmgrid.m