zjk/AUV_150
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

修改速度

Browse Source
This commit is contained in:
zhaojingkui
2025-08-12 15:14:21 +08:00
parent 9c7b1d3ae2
commit fce40a81d0
14 changed files with 235 additions and 148 deletions
Download Patch File Download Diff File Expand all files Collapse all files

26
missions/auv150/alpha_shoreside.moos
View File

@@ -77,7 +77,29 @@ ProcessConfig = pMarineViewer
hash_shade = 0.4 hash_shade = 0.4
hash_viewable = true hash_viewable = true
scope = ODOMETRY_DIST scope = rtU_speed_cmd
scope = rtU_u
scope = rtU_v
scope = rtU_w
scope = rtU_phi
scope = rtU_theta
scope = rtU_psi
scope = rtU_x
scope = rtU_y
scope = rtU_z
scope = rtU_dx
scope = rtU_dy
scope = rtU_dz
scope = rtU_heading_cmd
scope = rtU_depth_cmd
scope = rtY_MainThrusterSpeedCmd
scope = rtY_DirectUpperRudderServoAngleCmd
scope = rtY_DirectLowerRudderServoAngleCmd
scope = rtY_DirectLeftRudderServoAngleCmd
scope = rtY_DirectRightRudderServoAngleCmd
scope = rtY_heading_error
scope = rtY_pitch_error
scope = rtY_depth_error
// Appcast configuration // Appcast configuration
appcast_height = 75 appcast_height = 75
@@ -92,7 +114,7 @@ ProcessConfig = pMarineViewer
BUTTON_ONE = MOOS_MANUAL_OVERIDE=false # RETURN=false BUTTON_ONE = MOOS_MANUAL_OVERIDE=false # RETURN=false
BUTTON_TWO = RETURN # RETURN=true BUTTON_TWO = RETURN # RETURN=true
BUTTON_Three = PZ # PZ=true BUTTON_Three = PZ # PZ=true
BUTTON_Four = LED # LED=on BUTTON_Four = LED # LED=on

2
missions/auv150/gly_1.bhv
View File

@@ -36,7 +36,7 @@ Behavior = BHV_Waypoint
lead = 8 lead = 8
lead_damper = 1 lead_damper = 1
lead_to_start = true lead_to_start = true
speed = 2 // meters per second speed = 2 // meters per second
capture_line = true capture_line = true
capture_radius = 5.0 capture_radius = 5.0
slip_radius = 15.0 slip_radius = 15.0

61
src/pAUV150/AUV150.cpp
View File

@@ -258,7 +258,68 @@ bool AUV150::Iterate()
m_sqlite.insertData(m_status); m_sqlite.insertData(m_status);
m_sqlite.insertData(m_CommandFrame); m_sqlite.insertData(m_CommandFrame);
m_sqlite.insertData(m_FeedbackFrame); m_sqlite.insertData(m_FeedbackFrame);
// 发送状态
// ExtU rtU;
// External outputs
// ExtY rtY;
// Notify all ExtU variables
// string sU;
// sU.append("u=" + to_string(m_control.rtU.u));
// sU.append(",v=" + to_string(m_control.rtU.v));
// sU.append(",w=" + to_string(m_control.rtU.w));
// sU.append(",phi=" + to_string(m_control.rtU.phi));
// sU.append(",theta=" + to_string(m_control.rtU.theta));
// sU.append(",psi=" + to_string(m_control.rtU.psi));
// sU.append(",x=" + to_string(m_control.rtU.x));
// sU.append(",y=" + to_string(m_control.rtU.y));
// sU.append(",z=" + to_string(m_control.rtU.z));
// sU.append(",dx=" + to_string(m_control.rtU.dx));
// sU.append(",dy=" + to_string(m_control.rtU.dy));
// sU.append(",dz=" + to_string(m_control.rtU.dz));
// sU.append(",speed_cmd=" + to_string(m_control.rtU.speed_cmd));
// sU.append(",heading_cmd=" + to_string(m_control.rtU.heading_cmd));
// sU.append(",depth_cmd=" + to_string(m_control.rtU.depth_cmd));
// Notify("rtU", sU);
// // Notify all ExtY variables
// string sY;
// sY.append("MainThrusterSpeedCmd=" + to_string(m_control.rtY.MainThrusterSpeedCmd));
// sY.append(",DirectUpperRudderServoAngleCmd=" + to_string(m_control.rtY.DirectUpperRudderServoAngleCmd));
// sY.append(",DirectLowerRudderServoAngleCmd=" + to_string(m_control.rtY.DirectLowerRudderServoAngleCmd));
// sY.append(",DirectLeftRudderServoAngleCmd=" + to_string(m_control.rtY.DirectLeftRudderServoAngleCmd));
// sY.append(",DirectRightRudderServoAngleCmd=" + to_string(m_control.rtY.DirectRightRudderServoAngleCmd));
// sY.append(",heading_error=" + to_string(m_control.rtY.heading_error));
// sY.append(",pitch_error=" + to_string(m_control.rtY.pitch_error));
// sY.append(",depth_error=" + to_string(m_control.rtY.depth_error));
// Notify("rtY", sY);
// Notify individual variables for easier parsing
Notify("rtU_u", m_control.rtU.u);
Notify("rtU_v", m_control.rtU.v);
Notify("rtU_w", m_control.rtU.w);
Notify("rtU_phi", m_control.rtU.phi);
Notify("rtU_theta", m_control.rtU.theta);
Notify("rtU_psi", m_control.rtU.psi);
Notify("rtU_x", m_control.rtU.x);
Notify("rtU_y", m_control.rtU.y);
Notify("rtU_z", m_control.rtU.z);
Notify("rtU_dx", m_control.rtU.dx);
Notify("rtU_dy", m_control.rtU.dy);
Notify("rtU_dz", m_control.rtU.dz);
Notify("rtU_speed_cmd", m_control.rtU.speed_cmd);
Notify("rtU_heading_cmd", m_control.rtU.heading_cmd);
Notify("rtU_depth_cmd", m_control.rtU.depth_cmd);
Notify("rtY_MainThrusterSpeedCmd", m_control.rtY.MainThrusterSpeedCmd);
Notify("rtY_DirectUpperRudderServoAngleCmd", m_control.rtY.DirectUpperRudderServoAngleCmd);
Notify("rtY_DirectLowerRudderServoAngleCmd", m_control.rtY.DirectLowerRudderServoAngleCmd);
Notify("rtY_DirectLeftRudderServoAngleCmd", m_control.rtY.DirectLeftRudderServoAngleCmd);
Notify("rtY_DirectRightRudderServoAngleCmd", m_control.rtY.DirectRightRudderServoAngleCmd);
Notify("rtY_heading_error", m_control.rtY.heading_error);
Notify("rtY_pitch_error", m_control.rtY.pitch_error);
Notify("rtY_depth_error", m_control.rtY.depth_error);
AppCastingMOOSApp::PostReport(); AppCastingMOOSApp::PostReport();
return(true); return(true);
} }

2
src/pAUV150/AUV150.h
View File

@@ -181,7 +181,9 @@ private: // State variables
bool m_bConnected; bool m_bConnected;
std::set<unsigned char> m_faultCodes; std::set<unsigned char> m_faultCodes;
unsigned long int m_counter; unsigned long int m_counter;
SQLite m_sqlite; SQLite m_sqlite;
//导航相关 //导航相关
CMOOSGeodesy m_geodesy; CMOOSGeodesy m_geodesy;

12
src/pAUV150/Controler/Controler.cpp Normal file → Executable file
View File

@@ -7,9 +7,9 @@
// //
// Code generated for Simulink model 'Controler'. // Code generated for Simulink model 'Controler'.
// //
// Model version : 5.105 // Model version : 5.115
// Simulink Coder version : 24.2 (R2024b) 21-Jun-2024 // Simulink Coder version : 24.2 (R2024b) 21-Jun-2024
// C/C++ source code generated on : Thu Jul 3 16:12:45 2025 // C/C++ source code generated on : Tue Aug 12 11:26:01 2025
// //
// Target selection: ert.tlc // Target selection: ert.tlc
// Embedded hardware selection: Intel->x86-64 (Linux 64) // Embedded hardware selection: Intel->x86-64 (Linux 64)
@@ -261,12 +261,14 @@ void Controler::step()
// Update for DiscreteIntegrator: '<S36>/Filter' // Update for DiscreteIntegrator: '<S36>/Filter'
rtDW.Filter_DSTATE_m += 0.1 * rtb_FilterCoefficient_a; rtDW.Filter_DSTATE_m += 0.1 * rtb_FilterCoefficient_a;
// End of Outputs for SubSystem: '<Root>/Controler'
// Outport: '<Root>/MainThrusterSpeedCmd' incorporates: // Outport: '<Root>/MainThrusterSpeedCmd' incorporates:
// Constant: '<S1>/Constant1' // Constant: '<S1>/Constant1'
// Inport: '<Root>/speed_cmd'
// Product: '<S1>/Divide'
rtY.MainThrusterSpeedCmd = 100.0; rtY.MainThrusterSpeedCmd = rtU.speed_cmd / 0.025;
// End of Outputs for SubSystem: '<Root>/Controler'
// Outport: '<Root>/DirectUpperRudderServoAngleCmd' // Outport: '<Root>/DirectUpperRudderServoAngleCmd'
rtY.DirectUpperRudderServoAngleCmd = rtb_Integrator_l; rtY.DirectUpperRudderServoAngleCmd = rtb_Integrator_l;

234
src/pAUV150/Controler/Controler.h Normal file → Executable file
View File

@@ -7,9 +7,9 @@
// //
// Code generated for Simulink model 'Controler'. // Code generated for Simulink model 'Controler'.
// //
// Model version : 5.105 // Model version : 5.115
// Simulink Coder version : 24.2 (R2024b) 21-Jun-2024 // Simulink Coder version : 24.2 (R2024b) 21-Jun-2024
// C/C++ source code generated on : Thu Jul 3 16:12:45 2025 // C/C++ source code generated on : Tue Aug 12 11:26:01 2025
// //
// Target selection: ert.tlc // Target selection: ert.tlc
// Embedded hardware selection: Intel->x86-64 (Linux 64) // Embedded hardware selection: Intel->x86-64 (Linux 64)
@@ -169,124 +169,124 @@ class Controler final
// MATLAB hilite_system command to trace the generated code back // MATLAB hilite_system command to trace the generated code back
// to the parent model. For example, // to the parent model. For example,
// //
// hilite_system('SimModel0621_S3/Controler') - opens subsystem SimModel0621_S3/Controler // hilite_system('SimModel0621_S4/Controler') - opens subsystem SimModel0621_S4/Controler
// hilite_system('SimModel0621_S3/Controler/Kp') - opens and selects block Kp // hilite_system('SimModel0621_S4/Controler/Kp') - opens and selects block Kp
// //
// Here is the system hierarchy for this model // Here is the system hierarchy for this model
// //
// '<Root>' : 'SimModel0621_S3' // '<Root>' : 'SimModel0621_S4'
// '<S1>' : 'SimModel0621_S3/Controler' // '<S1>' : 'SimModel0621_S4/Controler'
// '<S2>' : 'SimModel0621_S3/Controler/MATLAB Function1' // '<S2>' : 'SimModel0621_S4/Controler/MATLAB Function1'
// '<S3>' : 'SimModel0621_S3/Controler/PID Controller1' // '<S3>' : 'SimModel0621_S4/Controler/PID Controller1'
// '<S4>' : 'SimModel0621_S3/Controler/PID Controller3' // '<S4>' : 'SimModel0621_S4/Controler/PID Controller3'
// '<S5>' : 'SimModel0621_S3/Controler/PID Controller1/Anti-windup' // '<S5>' : 'SimModel0621_S4/Controler/PID Controller1/Anti-windup'
// '<S6>' : 'SimModel0621_S3/Controler/PID Controller1/D Gain' // '<S6>' : 'SimModel0621_S4/Controler/PID Controller1/D Gain'
// '<S7>' : 'SimModel0621_S3/Controler/PID Controller1/External Derivative' // '<S7>' : 'SimModel0621_S4/Controler/PID Controller1/External Derivative'
// '<S8>' : 'SimModel0621_S3/Controler/PID Controller1/Filter' // '<S8>' : 'SimModel0621_S4/Controler/PID Controller1/Filter'
// '<S9>' : 'SimModel0621_S3/Controler/PID Controller1/Filter ICs' // '<S9>' : 'SimModel0621_S4/Controler/PID Controller1/Filter ICs'
// '<S10>' : 'SimModel0621_S3/Controler/PID Controller1/I Gain' // '<S10>' : 'SimModel0621_S4/Controler/PID Controller1/I Gain'
// '<S11>' : 'SimModel0621_S3/Controler/PID Controller1/Ideal P Gain' // '<S11>' : 'SimModel0621_S4/Controler/PID Controller1/Ideal P Gain'
// '<S12>' : 'SimModel0621_S3/Controler/PID Controller1/Ideal P Gain Fdbk' // '<S12>' : 'SimModel0621_S4/Controler/PID Controller1/Ideal P Gain Fdbk'
// '<S13>' : 'SimModel0621_S3/Controler/PID Controller1/Integrator' // '<S13>' : 'SimModel0621_S4/Controler/PID Controller1/Integrator'
// '<S14>' : 'SimModel0621_S3/Controler/PID Controller1/Integrator ICs' // '<S14>' : 'SimModel0621_S4/Controler/PID Controller1/Integrator ICs'
// '<S15>' : 'SimModel0621_S3/Controler/PID Controller1/N Copy' // '<S15>' : 'SimModel0621_S4/Controler/PID Controller1/N Copy'
// '<S16>' : 'SimModel0621_S3/Controler/PID Controller1/N Gain' // '<S16>' : 'SimModel0621_S4/Controler/PID Controller1/N Gain'
// '<S17>' : 'SimModel0621_S3/Controler/PID Controller1/P Copy' // '<S17>' : 'SimModel0621_S4/Controler/PID Controller1/P Copy'
// '<S18>' : 'SimModel0621_S3/Controler/PID Controller1/Parallel P Gain' // '<S18>' : 'SimModel0621_S4/Controler/PID Controller1/Parallel P Gain'
// '<S19>' : 'SimModel0621_S3/Controler/PID Controller1/Reset Signal' // '<S19>' : 'SimModel0621_S4/Controler/PID Controller1/Reset Signal'
// '<S20>' : 'SimModel0621_S3/Controler/PID Controller1/Saturation' // '<S20>' : 'SimModel0621_S4/Controler/PID Controller1/Saturation'
// '<S21>' : 'SimModel0621_S3/Controler/PID Controller1/Saturation Fdbk' // '<S21>' : 'SimModel0621_S4/Controler/PID Controller1/Saturation Fdbk'
// '<S22>' : 'SimModel0621_S3/Controler/PID Controller1/Sum' // '<S22>' : 'SimModel0621_S4/Controler/PID Controller1/Sum'
// '<S23>' : 'SimModel0621_S3/Controler/PID Controller1/Sum Fdbk' // '<S23>' : 'SimModel0621_S4/Controler/PID Controller1/Sum Fdbk'
// '<S24>' : 'SimModel0621_S3/Controler/PID Controller1/Tracking Mode' // '<S24>' : 'SimModel0621_S4/Controler/PID Controller1/Tracking Mode'
// '<S25>' : 'SimModel0621_S3/Controler/PID Controller1/Tracking Mode Sum' // '<S25>' : 'SimModel0621_S4/Controler/PID Controller1/Tracking Mode Sum'
// '<S26>' : 'SimModel0621_S3/Controler/PID Controller1/Tsamp - Integral' // '<S26>' : 'SimModel0621_S4/Controler/PID Controller1/Tsamp - Integral'
// '<S27>' : 'SimModel0621_S3/Controler/PID Controller1/Tsamp - Ngain' // '<S27>' : 'SimModel0621_S4/Controler/PID Controller1/Tsamp - Ngain'
// '<S28>' : 'SimModel0621_S3/Controler/PID Controller1/postSat Signal' // '<S28>' : 'SimModel0621_S4/Controler/PID Controller1/postSat Signal'
// '<S29>' : 'SimModel0621_S3/Controler/PID Controller1/preInt Signal' // '<S29>' : 'SimModel0621_S4/Controler/PID Controller1/preInt Signal'
// '<S30>' : 'SimModel0621_S3/Controler/PID Controller1/preSat Signal' // '<S30>' : 'SimModel0621_S4/Controler/PID Controller1/preSat Signal'
// '<S31>' : 'SimModel0621_S3/Controler/PID Controller1/Anti-windup/Disc. Clamping Parallel' // '<S31>' : 'SimModel0621_S4/Controler/PID Controller1/Anti-windup/Disc. Clamping Parallel'
// '<S32>' : 'SimModel0621_S3/Controler/PID Controller1/Anti-windup/Disc. Clamping Parallel/Dead Zone' // '<S32>' : 'SimModel0621_S4/Controler/PID Controller1/Anti-windup/Disc. Clamping Parallel/Dead Zone'
// '<S33>' : 'SimModel0621_S3/Controler/PID Controller1/Anti-windup/Disc. Clamping Parallel/Dead Zone/Enabled' // '<S33>' : 'SimModel0621_S4/Controler/PID Controller1/Anti-windup/Disc. Clamping Parallel/Dead Zone/Enabled'
// '<S34>' : 'SimModel0621_S3/Controler/PID Controller1/D Gain/Internal Parameters' // '<S34>' : 'SimModel0621_S4/Controler/PID Controller1/D Gain/Internal Parameters'
// '<S35>' : 'SimModel0621_S3/Controler/PID Controller1/External Derivative/Error' // '<S35>' : 'SimModel0621_S4/Controler/PID Controller1/External Derivative/Error'
// '<S36>' : 'SimModel0621_S3/Controler/PID Controller1/Filter/Disc. Forward Euler Filter' // '<S36>' : 'SimModel0621_S4/Controler/PID Controller1/Filter/Disc. Forward Euler Filter'
// '<S37>' : 'SimModel0621_S3/Controler/PID Controller1/Filter ICs/Internal IC - Filter' // '<S37>' : 'SimModel0621_S4/Controler/PID Controller1/Filter ICs/Internal IC - Filter'
// '<S38>' : 'SimModel0621_S3/Controler/PID Controller1/I Gain/Internal Parameters' // '<S38>' : 'SimModel0621_S4/Controler/PID Controller1/I Gain/Internal Parameters'
// '<S39>' : 'SimModel0621_S3/Controler/PID Controller1/Ideal P Gain/Passthrough' // '<S39>' : 'SimModel0621_S4/Controler/PID Controller1/Ideal P Gain/Passthrough'
// '<S40>' : 'SimModel0621_S3/Controler/PID Controller1/Ideal P Gain Fdbk/Disabled' // '<S40>' : 'SimModel0621_S4/Controler/PID Controller1/Ideal P Gain Fdbk/Disabled'
// '<S41>' : 'SimModel0621_S3/Controler/PID Controller1/Integrator/Discrete' // '<S41>' : 'SimModel0621_S4/Controler/PID Controller1/Integrator/Discrete'
// '<S42>' : 'SimModel0621_S3/Controler/PID Controller1/Integrator ICs/Internal IC' // '<S42>' : 'SimModel0621_S4/Controler/PID Controller1/Integrator ICs/Internal IC'
// '<S43>' : 'SimModel0621_S3/Controler/PID Controller1/N Copy/Disabled' // '<S43>' : 'SimModel0621_S4/Controler/PID Controller1/N Copy/Disabled'
// '<S44>' : 'SimModel0621_S3/Controler/PID Controller1/N Gain/Internal Parameters' // '<S44>' : 'SimModel0621_S4/Controler/PID Controller1/N Gain/Internal Parameters'
// '<S45>' : 'SimModel0621_S3/Controler/PID Controller1/P Copy/Disabled' // '<S45>' : 'SimModel0621_S4/Controler/PID Controller1/P Copy/Disabled'
// '<S46>' : 'SimModel0621_S3/Controler/PID Controller1/Parallel P Gain/Internal Parameters' // '<S46>' : 'SimModel0621_S4/Controler/PID Controller1/Parallel P Gain/Internal Parameters'
// '<S47>' : 'SimModel0621_S3/Controler/PID Controller1/Reset Signal/Disabled' // '<S47>' : 'SimModel0621_S4/Controler/PID Controller1/Reset Signal/Disabled'
// '<S48>' : 'SimModel0621_S3/Controler/PID Controller1/Saturation/Enabled' // '<S48>' : 'SimModel0621_S4/Controler/PID Controller1/Saturation/Enabled'
// '<S49>' : 'SimModel0621_S3/Controler/PID Controller1/Saturation Fdbk/Disabled' // '<S49>' : 'SimModel0621_S4/Controler/PID Controller1/Saturation Fdbk/Disabled'
// '<S50>' : 'SimModel0621_S3/Controler/PID Controller1/Sum/Sum_PID' // '<S50>' : 'SimModel0621_S4/Controler/PID Controller1/Sum/Sum_PID'
// '<S51>' : 'SimModel0621_S3/Controler/PID Controller1/Sum Fdbk/Disabled' // '<S51>' : 'SimModel0621_S4/Controler/PID Controller1/Sum Fdbk/Disabled'
// '<S52>' : 'SimModel0621_S3/Controler/PID Controller1/Tracking Mode/Disabled' // '<S52>' : 'SimModel0621_S4/Controler/PID Controller1/Tracking Mode/Disabled'
// '<S53>' : 'SimModel0621_S3/Controler/PID Controller1/Tracking Mode Sum/Passthrough' // '<S53>' : 'SimModel0621_S4/Controler/PID Controller1/Tracking Mode Sum/Passthrough'
// '<S54>' : 'SimModel0621_S3/Controler/PID Controller1/Tsamp - Integral/TsSignalSpecification' // '<S54>' : 'SimModel0621_S4/Controler/PID Controller1/Tsamp - Integral/TsSignalSpecification'
// '<S55>' : 'SimModel0621_S3/Controler/PID Controller1/Tsamp - Ngain/Passthrough' // '<S55>' : 'SimModel0621_S4/Controler/PID Controller1/Tsamp - Ngain/Passthrough'
// '<S56>' : 'SimModel0621_S3/Controler/PID Controller1/postSat Signal/Forward_Path' // '<S56>' : 'SimModel0621_S4/Controler/PID Controller1/postSat Signal/Forward_Path'
// '<S57>' : 'SimModel0621_S3/Controler/PID Controller1/preInt Signal/Internal PreInt' // '<S57>' : 'SimModel0621_S4/Controler/PID Controller1/preInt Signal/Internal PreInt'
// '<S58>' : 'SimModel0621_S3/Controler/PID Controller1/preSat Signal/Forward_Path' // '<S58>' : 'SimModel0621_S4/Controler/PID Controller1/preSat Signal/Forward_Path'
// '<S59>' : 'SimModel0621_S3/Controler/PID Controller3/Anti-windup' // '<S59>' : 'SimModel0621_S4/Controler/PID Controller3/Anti-windup'
// '<S60>' : 'SimModel0621_S3/Controler/PID Controller3/D Gain' // '<S60>' : 'SimModel0621_S4/Controler/PID Controller3/D Gain'
// '<S61>' : 'SimModel0621_S3/Controler/PID Controller3/External Derivative' // '<S61>' : 'SimModel0621_S4/Controler/PID Controller3/External Derivative'
// '<S62>' : 'SimModel0621_S3/Controler/PID Controller3/Filter' // '<S62>' : 'SimModel0621_S4/Controler/PID Controller3/Filter'
// '<S63>' : 'SimModel0621_S3/Controler/PID Controller3/Filter ICs' // '<S63>' : 'SimModel0621_S4/Controler/PID Controller3/Filter ICs'
// '<S64>' : 'SimModel0621_S3/Controler/PID Controller3/I Gain' // '<S64>' : 'SimModel0621_S4/Controler/PID Controller3/I Gain'
// '<S65>' : 'SimModel0621_S3/Controler/PID Controller3/Ideal P Gain' // '<S65>' : 'SimModel0621_S4/Controler/PID Controller3/Ideal P Gain'
// '<S66>' : 'SimModel0621_S3/Controler/PID Controller3/Ideal P Gain Fdbk' // '<S66>' : 'SimModel0621_S4/Controler/PID Controller3/Ideal P Gain Fdbk'
// '<S67>' : 'SimModel0621_S3/Controler/PID Controller3/Integrator' // '<S67>' : 'SimModel0621_S4/Controler/PID Controller3/Integrator'
// '<S68>' : 'SimModel0621_S3/Controler/PID Controller3/Integrator ICs' // '<S68>' : 'SimModel0621_S4/Controler/PID Controller3/Integrator ICs'
// '<S69>' : 'SimModel0621_S3/Controler/PID Controller3/N Copy' // '<S69>' : 'SimModel0621_S4/Controler/PID Controller3/N Copy'
// '<S70>' : 'SimModel0621_S3/Controler/PID Controller3/N Gain' // '<S70>' : 'SimModel0621_S4/Controler/PID Controller3/N Gain'
// '<S71>' : 'SimModel0621_S3/Controler/PID Controller3/P Copy' // '<S71>' : 'SimModel0621_S4/Controler/PID Controller3/P Copy'
// '<S72>' : 'SimModel0621_S3/Controler/PID Controller3/Parallel P Gain' // '<S72>' : 'SimModel0621_S4/Controler/PID Controller3/Parallel P Gain'
// '<S73>' : 'SimModel0621_S3/Controler/PID Controller3/Reset Signal' // '<S73>' : 'SimModel0621_S4/Controler/PID Controller3/Reset Signal'
// '<S74>' : 'SimModel0621_S3/Controler/PID Controller3/Saturation' // '<S74>' : 'SimModel0621_S4/Controler/PID Controller3/Saturation'
// '<S75>' : 'SimModel0621_S3/Controler/PID Controller3/Saturation Fdbk' // '<S75>' : 'SimModel0621_S4/Controler/PID Controller3/Saturation Fdbk'
// '<S76>' : 'SimModel0621_S3/Controler/PID Controller3/Sum' // '<S76>' : 'SimModel0621_S4/Controler/PID Controller3/Sum'
// '<S77>' : 'SimModel0621_S3/Controler/PID Controller3/Sum Fdbk' // '<S77>' : 'SimModel0621_S4/Controler/PID Controller3/Sum Fdbk'
// '<S78>' : 'SimModel0621_S3/Controler/PID Controller3/Tracking Mode' // '<S78>' : 'SimModel0621_S4/Controler/PID Controller3/Tracking Mode'
// '<S79>' : 'SimModel0621_S3/Controler/PID Controller3/Tracking Mode Sum' // '<S79>' : 'SimModel0621_S4/Controler/PID Controller3/Tracking Mode Sum'
// '<S80>' : 'SimModel0621_S3/Controler/PID Controller3/Tsamp - Integral' // '<S80>' : 'SimModel0621_S4/Controler/PID Controller3/Tsamp - Integral'
// '<S81>' : 'SimModel0621_S3/Controler/PID Controller3/Tsamp - Ngain' // '<S81>' : 'SimModel0621_S4/Controler/PID Controller3/Tsamp - Ngain'
// '<S82>' : 'SimModel0621_S3/Controler/PID Controller3/postSat Signal' // '<S82>' : 'SimModel0621_S4/Controler/PID Controller3/postSat Signal'
// '<S83>' : 'SimModel0621_S3/Controler/PID Controller3/preInt Signal' // '<S83>' : 'SimModel0621_S4/Controler/PID Controller3/preInt Signal'
// '<S84>' : 'SimModel0621_S3/Controler/PID Controller3/preSat Signal' // '<S84>' : 'SimModel0621_S4/Controler/PID Controller3/preSat Signal'
// '<S85>' : 'SimModel0621_S3/Controler/PID Controller3/Anti-windup/Disc. Clamping Parallel' // '<S85>' : 'SimModel0621_S4/Controler/PID Controller3/Anti-windup/Disc. Clamping Parallel'
// '<S86>' : 'SimModel0621_S3/Controler/PID Controller3/Anti-windup/Disc. Clamping Parallel/Dead Zone' // '<S86>' : 'SimModel0621_S4/Controler/PID Controller3/Anti-windup/Disc. Clamping Parallel/Dead Zone'
// '<S87>' : 'SimModel0621_S3/Controler/PID Controller3/Anti-windup/Disc. Clamping Parallel/Dead Zone/Enabled' // '<S87>' : 'SimModel0621_S4/Controler/PID Controller3/Anti-windup/Disc. Clamping Parallel/Dead Zone/Enabled'
// '<S88>' : 'SimModel0621_S3/Controler/PID Controller3/D Gain/Internal Parameters' // '<S88>' : 'SimModel0621_S4/Controler/PID Controller3/D Gain/Internal Parameters'
// '<S89>' : 'SimModel0621_S3/Controler/PID Controller3/External Derivative/Error' // '<S89>' : 'SimModel0621_S4/Controler/PID Controller3/External Derivative/Error'
// '<S90>' : 'SimModel0621_S3/Controler/PID Controller3/Filter/Disc. Forward Euler Filter' // '<S90>' : 'SimModel0621_S4/Controler/PID Controller3/Filter/Disc. Forward Euler Filter'
// '<S91>' : 'SimModel0621_S3/Controler/PID Controller3/Filter ICs/Internal IC - Filter' // '<S91>' : 'SimModel0621_S4/Controler/PID Controller3/Filter ICs/Internal IC - Filter'
// '<S92>' : 'SimModel0621_S3/Controler/PID Controller3/I Gain/Internal Parameters' // '<S92>' : 'SimModel0621_S4/Controler/PID Controller3/I Gain/Internal Parameters'
// '<S93>' : 'SimModel0621_S3/Controler/PID Controller3/Ideal P Gain/Passthrough' // '<S93>' : 'SimModel0621_S4/Controler/PID Controller3/Ideal P Gain/Passthrough'
// '<S94>' : 'SimModel0621_S3/Controler/PID Controller3/Ideal P Gain Fdbk/Disabled' // '<S94>' : 'SimModel0621_S4/Controler/PID Controller3/Ideal P Gain Fdbk/Disabled'
// '<S95>' : 'SimModel0621_S3/Controler/PID Controller3/Integrator/Discrete' // '<S95>' : 'SimModel0621_S4/Controler/PID Controller3/Integrator/Discrete'
// '<S96>' : 'SimModel0621_S3/Controler/PID Controller3/Integrator ICs/Internal IC' // '<S96>' : 'SimModel0621_S4/Controler/PID Controller3/Integrator ICs/Internal IC'
// '<S97>' : 'SimModel0621_S3/Controler/PID Controller3/N Copy/Disabled' // '<S97>' : 'SimModel0621_S4/Controler/PID Controller3/N Copy/Disabled'
// '<S98>' : 'SimModel0621_S3/Controler/PID Controller3/N Gain/Internal Parameters' // '<S98>' : 'SimModel0621_S4/Controler/PID Controller3/N Gain/Internal Parameters'
// '<S99>' : 'SimModel0621_S3/Controler/PID Controller3/P Copy/Disabled' // '<S99>' : 'SimModel0621_S4/Controler/PID Controller3/P Copy/Disabled'
// '<S100>' : 'SimModel0621_S3/Controler/PID Controller3/Parallel P Gain/Internal Parameters' // '<S100>' : 'SimModel0621_S4/Controler/PID Controller3/Parallel P Gain/Internal Parameters'
// '<S101>' : 'SimModel0621_S3/Controler/PID Controller3/Reset Signal/Disabled' // '<S101>' : 'SimModel0621_S4/Controler/PID Controller3/Reset Signal/Disabled'
// '<S102>' : 'SimModel0621_S3/Controler/PID Controller3/Saturation/Enabled' // '<S102>' : 'SimModel0621_S4/Controler/PID Controller3/Saturation/Enabled'
// '<S103>' : 'SimModel0621_S3/Controler/PID Controller3/Saturation Fdbk/Disabled' // '<S103>' : 'SimModel0621_S4/Controler/PID Controller3/Saturation Fdbk/Disabled'
// '<S104>' : 'SimModel0621_S3/Controler/PID Controller3/Sum/Sum_PID' // '<S104>' : 'SimModel0621_S4/Controler/PID Controller3/Sum/Sum_PID'
// '<S105>' : 'SimModel0621_S3/Controler/PID Controller3/Sum Fdbk/Disabled' // '<S105>' : 'SimModel0621_S4/Controler/PID Controller3/Sum Fdbk/Disabled'
// '<S106>' : 'SimModel0621_S3/Controler/PID Controller3/Tracking Mode/Disabled' // '<S106>' : 'SimModel0621_S4/Controler/PID Controller3/Tracking Mode/Disabled'
// '<S107>' : 'SimModel0621_S3/Controler/PID Controller3/Tracking Mode Sum/Passthrough' // '<S107>' : 'SimModel0621_S4/Controler/PID Controller3/Tracking Mode Sum/Passthrough'
// '<S108>' : 'SimModel0621_S3/Controler/PID Controller3/Tsamp - Integral/TsSignalSpecification' // '<S108>' : 'SimModel0621_S4/Controler/PID Controller3/Tsamp - Integral/TsSignalSpecification'
// '<S109>' : 'SimModel0621_S3/Controler/PID Controller3/Tsamp - Ngain/Passthrough' // '<S109>' : 'SimModel0621_S4/Controler/PID Controller3/Tsamp - Ngain/Passthrough'
// '<S110>' : 'SimModel0621_S3/Controler/PID Controller3/postSat Signal/Forward_Path' // '<S110>' : 'SimModel0621_S4/Controler/PID Controller3/postSat Signal/Forward_Path'
// '<S111>' : 'SimModel0621_S3/Controler/PID Controller3/preInt Signal/Internal PreInt' // '<S111>' : 'SimModel0621_S4/Controler/PID Controller3/preInt Signal/Internal PreInt'
// '<S112>' : 'SimModel0621_S3/Controler/PID Controller3/preSat Signal/Forward_Path' // '<S112>' : 'SimModel0621_S4/Controler/PID Controller3/preSat Signal/Forward_Path'
#endif // Controler_h_ #endif // Controler_h_

16
src/pAUV150/Controler/Controler_data.cpp Normal file → Executable file
View File

@@ -7,9 +7,9 @@
// //
// Code generated for Simulink model 'Controler'. // Code generated for Simulink model 'Controler'.
// //
// Model version : 5.105 // Model version : 5.115
// Simulink Coder version : 24.2 (R2024b) 21-Jun-2024 // Simulink Coder version : 24.2 (R2024b) 21-Jun-2024
// C/C++ source code generated on : Thu Jul 3 16:12:45 2025 // C/C++ source code generated on : Tue Aug 12 11:26:01 2025
// //
// Target selection: ert.tlc // Target selection: ert.tlc
// Embedded hardware selection: Intel->x86-64 (Linux 64) // Embedded hardware selection: Intel->x86-64 (Linux 64)
@@ -30,10 +30,10 @@ Controler::P Controler::rtP{
// '<S46>/Proportional Gain' // '<S46>/Proportional Gain'
{ {
1, 1.0,
0.01, 0.01,
3, 0.01,
5.0 10.0
}, },
// Variable: pid_heading // Variable: pid_heading
@@ -44,9 +44,9 @@ Controler::P Controler::rtP{
// '<S100>/Proportional Gain' // '<S100>/Proportional Gain'
{ {
0.5, 10.0,
0.01, 1.0,
0.1, 5.0,
10.0 10.0
} }
}; };

4
src/pAUV150/Controler/Controler_private.h Normal file → Executable file
View File

@@ -7,9 +7,9 @@
// //
// Code generated for Simulink model 'Controler'. // Code generated for Simulink model 'Controler'.
// //
// Model version : 5.105 // Model version : 5.115
// Simulink Coder version : 24.2 (R2024b) 21-Jun-2024 // Simulink Coder version : 24.2 (R2024b) 21-Jun-2024
// C/C++ source code generated on : Thu Jul 3 16:12:45 2025 // C/C++ source code generated on : Tue Aug 12 11:26:01 2025
// //
// Target selection: ert.tlc // Target selection: ert.tlc
// Embedded hardware selection: Intel->x86-64 (Linux 64) // Embedded hardware selection: Intel->x86-64 (Linux 64)

4
src/pAUV150/Controler/Controler_types.h Normal file → Executable file
View File

@@ -7,9 +7,9 @@
// //
// Code generated for Simulink model 'Controler'. // Code generated for Simulink model 'Controler'.
// //
// Model version : 5.105 // Model version : 5.115
// Simulink Coder version : 24.2 (R2024b) 21-Jun-2024 // Simulink Coder version : 24.2 (R2024b) 21-Jun-2024
// C/C++ source code generated on : Thu Jul 3 16:12:45 2025 // C/C++ source code generated on : Tue Aug 12 11:26:01 2025
// //
// Target selection: ert.tlc // Target selection: ert.tlc
// Embedded hardware selection: Intel->x86-64 (Linux 64) // Embedded hardware selection: Intel->x86-64 (Linux 64)

4
src/pAUV150/Controler/rtGetNaN.cpp Normal file → Executable file
View File

@@ -7,9 +7,9 @@
// //
// Code generated for Simulink model 'Controler'. // Code generated for Simulink model 'Controler'.
// //
// Model version : 5.105 // Model version : 5.115
// Simulink Coder version : 24.2 (R2024b) 21-Jun-2024 // Simulink Coder version : 24.2 (R2024b) 21-Jun-2024
// C/C++ source code generated on : Thu Jul 3 16:12:45 2025 // C/C++ source code generated on : Tue Aug 12 11:26:01 2025
// //
// Target selection: ert.tlc // Target selection: ert.tlc
// Embedded hardware selection: Intel->x86-64 (Linux 64) // Embedded hardware selection: Intel->x86-64 (Linux 64)

4
src/pAUV150/Controler/rtGetNaN.h Normal file → Executable file
View File

@@ -7,9 +7,9 @@
// //
// Code generated for Simulink model 'Controler'. // Code generated for Simulink model 'Controler'.
// //
// Model version : 5.105 // Model version : 5.115
// Simulink Coder version : 24.2 (R2024b) 21-Jun-2024 // Simulink Coder version : 24.2 (R2024b) 21-Jun-2024
// C/C++ source code generated on : Thu Jul 3 16:12:45 2025 // C/C++ source code generated on : Tue Aug 12 11:26:01 2025
// //
// Target selection: ert.tlc // Target selection: ert.tlc
// Embedded hardware selection: Intel->x86-64 (Linux 64) // Embedded hardware selection: Intel->x86-64 (Linux 64)

4
src/pAUV150/Controler/rt_nonfinite.cpp Normal file → Executable file
View File

@@ -7,9 +7,9 @@
// //
// Code generated for Simulink model 'Controler'. // Code generated for Simulink model 'Controler'.
// //
// Model version : 5.105 // Model version : 5.115
// Simulink Coder version : 24.2 (R2024b) 21-Jun-2024 // Simulink Coder version : 24.2 (R2024b) 21-Jun-2024
// C/C++ source code generated on : Thu Jul 3 16:12:45 2025 // C/C++ source code generated on : Tue Aug 12 11:26:01 2025
// //
// Target selection: ert.tlc // Target selection: ert.tlc
// Embedded hardware selection: Intel->x86-64 (Linux 64) // Embedded hardware selection: Intel->x86-64 (Linux 64)

4
src/pAUV150/Controler/rt_nonfinite.h Normal file → Executable file
View File

@@ -7,9 +7,9 @@
// //
// Code generated for Simulink model 'Controler'. // Code generated for Simulink model 'Controler'.
// //
// Model version : 5.105 // Model version : 5.115
// Simulink Coder version : 24.2 (R2024b) 21-Jun-2024 // Simulink Coder version : 24.2 (R2024b) 21-Jun-2024
// C/C++ source code generated on : Thu Jul 3 16:12:45 2025 // C/C++ source code generated on : Tue Aug 12 11:26:01 2025
// //
// Target selection: ert.tlc // Target selection: ert.tlc
// Embedded hardware selection: Intel->x86-64 (Linux 64) // Embedded hardware selection: Intel->x86-64 (Linux 64)

6
src/pAUV150/Controler/rtwtypes.h Normal file → Executable file
View File

@@ -7,9 +7,9 @@
// //
// Code generated for Simulink model 'Controler'. // Code generated for Simulink model 'Controler'.
// //
// Model version : 5.105 // Model version : 5.115
// Simulink Coder version : 24.2 (R2024b) 21-Jun-2024 // Simulink Coder version : 24.2 (R2024b) 21-Jun-2024
// C/C++ source code generated on : Thu Jul 3 16:12:45 2025 // C/C++ source code generated on : Tue Aug 12 11:26:01 2025
// //
// Target selection: ert.tlc // Target selection: ert.tlc
// Embedded hardware selection: Intel->x86-64 (Linux 64) // Embedded hardware selection: Intel->x86-64 (Linux 64)
@@ -103,4 +103,4 @@ typedef void * pointer_T;
// File trailer for generated code. // File trailer for generated code.
// //
// [EOF] // [EOF]
// //