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

24
missions/auv150/alpha_shoreside.moos
View File

@@ -77,7 +77,29 @@ ProcessConfig = pMarineViewer
hash_shade = 0.4
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_height = 75

61
src/pAUV150/AUV150.cpp
View File

@@ -258,6 +258,67 @@ bool AUV150::Iterate()
m_sqlite.insertData(m_status);
m_sqlite.insertData(m_CommandFrame);
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();
return(true);

2
src/pAUV150/AUV150.h
View File

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

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

@@ -7,9 +7,9 @@
//
// Code generated for Simulink model 'Controler'.
//
// Model version : 5.105
// Model version : 5.115
// 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
// Embedded hardware selection: Intel->x86-64 (Linux 64)
@@ -261,12 +261,14 @@ void Controler::step()
// Update for DiscreteIntegrator: '<S36>/Filter'
rtDW.Filter_DSTATE_m += 0.1 * rtb_FilterCoefficient_a;
// End of Outputs for SubSystem: '<Root>/Controler'
// Outport: '<Root>/MainThrusterSpeedCmd' incorporates:
// 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'
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'.
//
// Model version : 5.105
// Model version : 5.115
// 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
// 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
// to the parent model. For example,
//
// hilite_system('SimModel0621_S3/Controler') - opens subsystem SimModel0621_S3/Controler
// hilite_system('SimModel0621_S3/Controler/Kp') - opens and selects block Kp
// hilite_system('SimModel0621_S4/Controler') - opens subsystem SimModel0621_S4/Controler
// hilite_system('SimModel0621_S4/Controler/Kp') - opens and selects block Kp
//
// Here is the system hierarchy for this model
//
// '<Root>' : 'SimModel0621_S3'
// '<S1>' : 'SimModel0621_S3/Controler'
// '<S2>' : 'SimModel0621_S3/Controler/MATLAB Function1'
// '<S3>' : 'SimModel0621_S3/Controler/PID Controller1'
// '<S4>' : 'SimModel0621_S3/Controler/PID Controller3'
// '<S5>' : 'SimModel0621_S3/Controler/PID Controller1/Anti-windup'
// '<S6>' : 'SimModel0621_S3/Controler/PID Controller1/D Gain'
// '<S7>' : 'SimModel0621_S3/Controler/PID Controller1/External Derivative'
// '<S8>' : 'SimModel0621_S3/Controler/PID Controller1/Filter'
// '<S9>' : 'SimModel0621_S3/Controler/PID Controller1/Filter ICs'
// '<S10>' : 'SimModel0621_S3/Controler/PID Controller1/I Gain'
// '<S11>' : 'SimModel0621_S3/Controler/PID Controller1/Ideal P Gain'
// '<S12>' : 'SimModel0621_S3/Controler/PID Controller1/Ideal P Gain Fdbk'
// '<S13>' : 'SimModel0621_S3/Controler/PID Controller1/Integrator'
// '<S14>' : 'SimModel0621_S3/Controler/PID Controller1/Integrator ICs'
// '<S15>' : 'SimModel0621_S3/Controler/PID Controller1/N Copy'
// '<S16>' : 'SimModel0621_S3/Controler/PID Controller1/N Gain'
// '<S17>' : 'SimModel0621_S3/Controler/PID Controller1/P Copy'
// '<S18>' : 'SimModel0621_S3/Controler/PID Controller1/Parallel P Gain'
// '<S19>' : 'SimModel0621_S3/Controler/PID Controller1/Reset Signal'
// '<S20>' : 'SimModel0621_S3/Controler/PID Controller1/Saturation'
// '<S21>' : 'SimModel0621_S3/Controler/PID Controller1/Saturation Fdbk'
// '<S22>' : 'SimModel0621_S3/Controler/PID Controller1/Sum'
// '<S23>' : 'SimModel0621_S3/Controler/PID Controller1/Sum Fdbk'
// '<S24>' : 'SimModel0621_S3/Controler/PID Controller1/Tracking Mode'
// '<S25>' : 'SimModel0621_S3/Controler/PID Controller1/Tracking Mode Sum'
// '<S26>' : 'SimModel0621_S3/Controler/PID Controller1/Tsamp - Integral'
// '<S27>' : 'SimModel0621_S3/Controler/PID Controller1/Tsamp - Ngain'
// '<S28>' : 'SimModel0621_S3/Controler/PID Controller1/postSat Signal'
// '<S29>' : 'SimModel0621_S3/Controler/PID Controller1/preInt Signal'
// '<S30>' : 'SimModel0621_S3/Controler/PID Controller1/preSat Signal'
// '<S31>' : 'SimModel0621_S3/Controler/PID Controller1/Anti-windup/Disc. Clamping Parallel'
// '<S32>' : 'SimModel0621_S3/Controler/PID Controller1/Anti-windup/Disc. Clamping Parallel/Dead Zone'
// '<S33>' : 'SimModel0621_S3/Controler/PID Controller1/Anti-windup/Disc. Clamping Parallel/Dead Zone/Enabled'
// '<S34>' : 'SimModel0621_S3/Controler/PID Controller1/D Gain/Internal Parameters'
// '<S35>' : 'SimModel0621_S3/Controler/PID Controller1/External Derivative/Error'
// '<S36>' : 'SimModel0621_S3/Controler/PID Controller1/Filter/Disc. Forward Euler Filter'
// '<S37>' : 'SimModel0621_S3/Controler/PID Controller1/Filter ICs/Internal IC - Filter'
// '<S38>' : 'SimModel0621_S3/Controler/PID Controller1/I Gain/Internal Parameters'
// '<S39>' : 'SimModel0621_S3/Controler/PID Controller1/Ideal P Gain/Passthrough'
// '<S40>' : 'SimModel0621_S3/Controler/PID Controller1/Ideal P Gain Fdbk/Disabled'
// '<S41>' : 'SimModel0621_S3/Controler/PID Controller1/Integrator/Discrete'
// '<S42>' : 'SimModel0621_S3/Controler/PID Controller1/Integrator ICs/Internal IC'
// '<S43>' : 'SimModel0621_S3/Controler/PID Controller1/N Copy/Disabled'
// '<S44>' : 'SimModel0621_S3/Controler/PID Controller1/N Gain/Internal Parameters'
// '<S45>' : 'SimModel0621_S3/Controler/PID Controller1/P Copy/Disabled'
// '<S46>' : 'SimModel0621_S3/Controler/PID Controller1/Parallel P Gain/Internal Parameters'
// '<S47>' : 'SimModel0621_S3/Controler/PID Controller1/Reset Signal/Disabled'
// '<S48>' : 'SimModel0621_S3/Controler/PID Controller1/Saturation/Enabled'
// '<S49>' : 'SimModel0621_S3/Controler/PID Controller1/Saturation Fdbk/Disabled'
// '<S50>' : 'SimModel0621_S3/Controler/PID Controller1/Sum/Sum_PID'
// '<S51>' : 'SimModel0621_S3/Controler/PID Controller1/Sum Fdbk/Disabled'
// '<S52>' : 'SimModel0621_S3/Controler/PID Controller1/Tracking Mode/Disabled'
// '<S53>' : 'SimModel0621_S3/Controler/PID Controller1/Tracking Mode Sum/Passthrough'
// '<S54>' : 'SimModel0621_S3/Controler/PID Controller1/Tsamp - Integral/TsSignalSpecification'
// '<S55>' : 'SimModel0621_S3/Controler/PID Controller1/Tsamp - Ngain/Passthrough'
// '<S56>' : 'SimModel0621_S3/Controler/PID Controller1/postSat Signal/Forward_Path'
// '<S57>' : 'SimModel0621_S3/Controler/PID Controller1/preInt Signal/Internal PreInt'
// '<S58>' : 'SimModel0621_S3/Controler/PID Controller1/preSat Signal/Forward_Path'
// '<S59>' : 'SimModel0621_S3/Controler/PID Controller3/Anti-windup'
// '<S60>' : 'SimModel0621_S3/Controler/PID Controller3/D Gain'
// '<S61>' : 'SimModel0621_S3/Controler/PID Controller3/External Derivative'
// '<S62>' : 'SimModel0621_S3/Controler/PID Controller3/Filter'
// '<S63>' : 'SimModel0621_S3/Controler/PID Controller3/Filter ICs'
// '<S64>' : 'SimModel0621_S3/Controler/PID Controller3/I Gain'
// '<S65>' : 'SimModel0621_S3/Controler/PID Controller3/Ideal P Gain'
// '<S66>' : 'SimModel0621_S3/Controler/PID Controller3/Ideal P Gain Fdbk'
// '<S67>' : 'SimModel0621_S3/Controler/PID Controller3/Integrator'
// '<S68>' : 'SimModel0621_S3/Controler/PID Controller3/Integrator ICs'
// '<S69>' : 'SimModel0621_S3/Controler/PID Controller3/N Copy'
// '<S70>' : 'SimModel0621_S3/Controler/PID Controller3/N Gain'
// '<S71>' : 'SimModel0621_S3/Controler/PID Controller3/P Copy'
// '<S72>' : 'SimModel0621_S3/Controler/PID Controller3/Parallel P Gain'
// '<S73>' : 'SimModel0621_S3/Controler/PID Controller3/Reset Signal'
// '<S74>' : 'SimModel0621_S3/Controler/PID Controller3/Saturation'
// '<S75>' : 'SimModel0621_S3/Controler/PID Controller3/Saturation Fdbk'
// '<S76>' : 'SimModel0621_S3/Controler/PID Controller3/Sum'
// '<S77>' : 'SimModel0621_S3/Controler/PID Controller3/Sum Fdbk'
// '<S78>' : 'SimModel0621_S3/Controler/PID Controller3/Tracking Mode'
// '<S79>' : 'SimModel0621_S3/Controler/PID Controller3/Tracking Mode Sum'
// '<S80>' : 'SimModel0621_S3/Controler/PID Controller3/Tsamp - Integral'
// '<S81>' : 'SimModel0621_S3/Controler/PID Controller3/Tsamp - Ngain'
// '<S82>' : 'SimModel0621_S3/Controler/PID Controller3/postSat Signal'
// '<S83>' : 'SimModel0621_S3/Controler/PID Controller3/preInt Signal'
// '<S84>' : 'SimModel0621_S3/Controler/PID Controller3/preSat Signal'
// '<S85>' : 'SimModel0621_S3/Controler/PID Controller3/Anti-windup/Disc. Clamping Parallel'
// '<S86>' : 'SimModel0621_S3/Controler/PID Controller3/Anti-windup/Disc. Clamping Parallel/Dead Zone'
// '<S87>' : 'SimModel0621_S3/Controler/PID Controller3/Anti-windup/Disc. Clamping Parallel/Dead Zone/Enabled'
// '<S88>' : 'SimModel0621_S3/Controler/PID Controller3/D Gain/Internal Parameters'
// '<S89>' : 'SimModel0621_S3/Controler/PID Controller3/External Derivative/Error'
// '<S90>' : 'SimModel0621_S3/Controler/PID Controller3/Filter/Disc. Forward Euler Filter'
// '<S91>' : 'SimModel0621_S3/Controler/PID Controller3/Filter ICs/Internal IC - Filter'
// '<S92>' : 'SimModel0621_S3/Controler/PID Controller3/I Gain/Internal Parameters'
// '<S93>' : 'SimModel0621_S3/Controler/PID Controller3/Ideal P Gain/Passthrough'
// '<S94>' : 'SimModel0621_S3/Controler/PID Controller3/Ideal P Gain Fdbk/Disabled'
// '<S95>' : 'SimModel0621_S3/Controler/PID Controller3/Integrator/Discrete'
// '<S96>' : 'SimModel0621_S3/Controler/PID Controller3/Integrator ICs/Internal IC'
// '<S97>' : 'SimModel0621_S3/Controler/PID Controller3/N Copy/Disabled'
// '<S98>' : 'SimModel0621_S3/Controler/PID Controller3/N Gain/Internal Parameters'
// '<S99>' : 'SimModel0621_S3/Controler/PID Controller3/P Copy/Disabled'
// '<S100>' : 'SimModel0621_S3/Controler/PID Controller3/Parallel P Gain/Internal Parameters'
// '<S101>' : 'SimModel0621_S3/Controler/PID Controller3/Reset Signal/Disabled'
// '<S102>' : 'SimModel0621_S3/Controler/PID Controller3/Saturation/Enabled'
// '<S103>' : 'SimModel0621_S3/Controler/PID Controller3/Saturation Fdbk/Disabled'
// '<S104>' : 'SimModel0621_S3/Controler/PID Controller3/Sum/Sum_PID'
// '<S105>' : 'SimModel0621_S3/Controler/PID Controller3/Sum Fdbk/Disabled'
// '<S106>' : 'SimModel0621_S3/Controler/PID Controller3/Tracking Mode/Disabled'
// '<S107>' : 'SimModel0621_S3/Controler/PID Controller3/Tracking Mode Sum/Passthrough'
// '<S108>' : 'SimModel0621_S3/Controler/PID Controller3/Tsamp - Integral/TsSignalSpecification'
// '<S109>' : 'SimModel0621_S3/Controler/PID Controller3/Tsamp - Ngain/Passthrough'
// '<S110>' : 'SimModel0621_S3/Controler/PID Controller3/postSat Signal/Forward_Path'
// '<S111>' : 'SimModel0621_S3/Controler/PID Controller3/preInt Signal/Internal PreInt'
// '<S112>' : 'SimModel0621_S3/Controler/PID Controller3/preSat Signal/Forward_Path'
// '<Root>' : 'SimModel0621_S4'
// '<S1>' : 'SimModel0621_S4/Controler'
// '<S2>' : 'SimModel0621_S4/Controler/MATLAB Function1'
// '<S3>' : 'SimModel0621_S4/Controler/PID Controller1'
// '<S4>' : 'SimModel0621_S4/Controler/PID Controller3'
// '<S5>' : 'SimModel0621_S4/Controler/PID Controller1/Anti-windup'
// '<S6>' : 'SimModel0621_S4/Controler/PID Controller1/D Gain'
// '<S7>' : 'SimModel0621_S4/Controler/PID Controller1/External Derivative'
// '<S8>' : 'SimModel0621_S4/Controler/PID Controller1/Filter'
// '<S9>' : 'SimModel0621_S4/Controler/PID Controller1/Filter ICs'
// '<S10>' : 'SimModel0621_S4/Controler/PID Controller1/I Gain'
// '<S11>' : 'SimModel0621_S4/Controler/PID Controller1/Ideal P Gain'
// '<S12>' : 'SimModel0621_S4/Controler/PID Controller1/Ideal P Gain Fdbk'
// '<S13>' : 'SimModel0621_S4/Controler/PID Controller1/Integrator'
// '<S14>' : 'SimModel0621_S4/Controler/PID Controller1/Integrator ICs'
// '<S15>' : 'SimModel0621_S4/Controler/PID Controller1/N Copy'
// '<S16>' : 'SimModel0621_S4/Controler/PID Controller1/N Gain'
// '<S17>' : 'SimModel0621_S4/Controler/PID Controller1/P Copy'
// '<S18>' : 'SimModel0621_S4/Controler/PID Controller1/Parallel P Gain'
// '<S19>' : 'SimModel0621_S4/Controler/PID Controller1/Reset Signal'
// '<S20>' : 'SimModel0621_S4/Controler/PID Controller1/Saturation'
// '<S21>' : 'SimModel0621_S4/Controler/PID Controller1/Saturation Fdbk'
// '<S22>' : 'SimModel0621_S4/Controler/PID Controller1/Sum'
// '<S23>' : 'SimModel0621_S4/Controler/PID Controller1/Sum Fdbk'
// '<S24>' : 'SimModel0621_S4/Controler/PID Controller1/Tracking Mode'
// '<S25>' : 'SimModel0621_S4/Controler/PID Controller1/Tracking Mode Sum'
// '<S26>' : 'SimModel0621_S4/Controler/PID Controller1/Tsamp - Integral'
// '<S27>' : 'SimModel0621_S4/Controler/PID Controller1/Tsamp - Ngain'
// '<S28>' : 'SimModel0621_S4/Controler/PID Controller1/postSat Signal'
// '<S29>' : 'SimModel0621_S4/Controler/PID Controller1/preInt Signal'
// '<S30>' : 'SimModel0621_S4/Controler/PID Controller1/preSat Signal'
// '<S31>' : 'SimModel0621_S4/Controler/PID Controller1/Anti-windup/Disc. Clamping Parallel'
// '<S32>' : 'SimModel0621_S4/Controler/PID Controller1/Anti-windup/Disc. Clamping Parallel/Dead Zone'
// '<S33>' : 'SimModel0621_S4/Controler/PID Controller1/Anti-windup/Disc. Clamping Parallel/Dead Zone/Enabled'
// '<S34>' : 'SimModel0621_S4/Controler/PID Controller1/D Gain/Internal Parameters'
// '<S35>' : 'SimModel0621_S4/Controler/PID Controller1/External Derivative/Error'
// '<S36>' : 'SimModel0621_S4/Controler/PID Controller1/Filter/Disc. Forward Euler Filter'
// '<S37>' : 'SimModel0621_S4/Controler/PID Controller1/Filter ICs/Internal IC - Filter'
// '<S38>' : 'SimModel0621_S4/Controler/PID Controller1/I Gain/Internal Parameters'
// '<S39>' : 'SimModel0621_S4/Controler/PID Controller1/Ideal P Gain/Passthrough'
// '<S40>' : 'SimModel0621_S4/Controler/PID Controller1/Ideal P Gain Fdbk/Disabled'
// '<S41>' : 'SimModel0621_S4/Controler/PID Controller1/Integrator/Discrete'
// '<S42>' : 'SimModel0621_S4/Controler/PID Controller1/Integrator ICs/Internal IC'
// '<S43>' : 'SimModel0621_S4/Controler/PID Controller1/N Copy/Disabled'
// '<S44>' : 'SimModel0621_S4/Controler/PID Controller1/N Gain/Internal Parameters'
// '<S45>' : 'SimModel0621_S4/Controler/PID Controller1/P Copy/Disabled'
// '<S46>' : 'SimModel0621_S4/Controler/PID Controller1/Parallel P Gain/Internal Parameters'
// '<S47>' : 'SimModel0621_S4/Controler/PID Controller1/Reset Signal/Disabled'
// '<S48>' : 'SimModel0621_S4/Controler/PID Controller1/Saturation/Enabled'
// '<S49>' : 'SimModel0621_S4/Controler/PID Controller1/Saturation Fdbk/Disabled'
// '<S50>' : 'SimModel0621_S4/Controler/PID Controller1/Sum/Sum_PID'
// '<S51>' : 'SimModel0621_S4/Controler/PID Controller1/Sum Fdbk/Disabled'
// '<S52>' : 'SimModel0621_S4/Controler/PID Controller1/Tracking Mode/Disabled'
// '<S53>' : 'SimModel0621_S4/Controler/PID Controller1/Tracking Mode Sum/Passthrough'
// '<S54>' : 'SimModel0621_S4/Controler/PID Controller1/Tsamp - Integral/TsSignalSpecification'
// '<S55>' : 'SimModel0621_S4/Controler/PID Controller1/Tsamp - Ngain/Passthrough'
// '<S56>' : 'SimModel0621_S4/Controler/PID Controller1/postSat Signal/Forward_Path'
// '<S57>' : 'SimModel0621_S4/Controler/PID Controller1/preInt Signal/Internal PreInt'
// '<S58>' : 'SimModel0621_S4/Controler/PID Controller1/preSat Signal/Forward_Path'
// '<S59>' : 'SimModel0621_S4/Controler/PID Controller3/Anti-windup'
// '<S60>' : 'SimModel0621_S4/Controler/PID Controller3/D Gain'
// '<S61>' : 'SimModel0621_S4/Controler/PID Controller3/External Derivative'
// '<S62>' : 'SimModel0621_S4/Controler/PID Controller3/Filter'
// '<S63>' : 'SimModel0621_S4/Controler/PID Controller3/Filter ICs'
// '<S64>' : 'SimModel0621_S4/Controler/PID Controller3/I Gain'
// '<S65>' : 'SimModel0621_S4/Controler/PID Controller3/Ideal P Gain'
// '<S66>' : 'SimModel0621_S4/Controler/PID Controller3/Ideal P Gain Fdbk'
// '<S67>' : 'SimModel0621_S4/Controler/PID Controller3/Integrator'
// '<S68>' : 'SimModel0621_S4/Controler/PID Controller3/Integrator ICs'
// '<S69>' : 'SimModel0621_S4/Controler/PID Controller3/N Copy'
// '<S70>' : 'SimModel0621_S4/Controler/PID Controller3/N Gain'
// '<S71>' : 'SimModel0621_S4/Controler/PID Controller3/P Copy'
// '<S72>' : 'SimModel0621_S4/Controler/PID Controller3/Parallel P Gain'
// '<S73>' : 'SimModel0621_S4/Controler/PID Controller3/Reset Signal'
// '<S74>' : 'SimModel0621_S4/Controler/PID Controller3/Saturation'
// '<S75>' : 'SimModel0621_S4/Controler/PID Controller3/Saturation Fdbk'
// '<S76>' : 'SimModel0621_S4/Controler/PID Controller3/Sum'
// '<S77>' : 'SimModel0621_S4/Controler/PID Controller3/Sum Fdbk'
// '<S78>' : 'SimModel0621_S4/Controler/PID Controller3/Tracking Mode'
// '<S79>' : 'SimModel0621_S4/Controler/PID Controller3/Tracking Mode Sum'
// '<S80>' : 'SimModel0621_S4/Controler/PID Controller3/Tsamp - Integral'
// '<S81>' : 'SimModel0621_S4/Controler/PID Controller3/Tsamp - Ngain'
// '<S82>' : 'SimModel0621_S4/Controler/PID Controller3/postSat Signal'
// '<S83>' : 'SimModel0621_S4/Controler/PID Controller3/preInt Signal'
// '<S84>' : 'SimModel0621_S4/Controler/PID Controller3/preSat Signal'
// '<S85>' : 'SimModel0621_S4/Controler/PID Controller3/Anti-windup/Disc. Clamping Parallel'
// '<S86>' : 'SimModel0621_S4/Controler/PID Controller3/Anti-windup/Disc. Clamping Parallel/Dead Zone'
// '<S87>' : 'SimModel0621_S4/Controler/PID Controller3/Anti-windup/Disc. Clamping Parallel/Dead Zone/Enabled'
// '<S88>' : 'SimModel0621_S4/Controler/PID Controller3/D Gain/Internal Parameters'
// '<S89>' : 'SimModel0621_S4/Controler/PID Controller3/External Derivative/Error'
// '<S90>' : 'SimModel0621_S4/Controler/PID Controller3/Filter/Disc. Forward Euler Filter'
// '<S91>' : 'SimModel0621_S4/Controler/PID Controller3/Filter ICs/Internal IC - Filter'
// '<S92>' : 'SimModel0621_S4/Controler/PID Controller3/I Gain/Internal Parameters'
// '<S93>' : 'SimModel0621_S4/Controler/PID Controller3/Ideal P Gain/Passthrough'
// '<S94>' : 'SimModel0621_S4/Controler/PID Controller3/Ideal P Gain Fdbk/Disabled'
// '<S95>' : 'SimModel0621_S4/Controler/PID Controller3/Integrator/Discrete'
// '<S96>' : 'SimModel0621_S4/Controler/PID Controller3/Integrator ICs/Internal IC'
// '<S97>' : 'SimModel0621_S4/Controler/PID Controller3/N Copy/Disabled'
// '<S98>' : 'SimModel0621_S4/Controler/PID Controller3/N Gain/Internal Parameters'
// '<S99>' : 'SimModel0621_S4/Controler/PID Controller3/P Copy/Disabled'
// '<S100>' : 'SimModel0621_S4/Controler/PID Controller3/Parallel P Gain/Internal Parameters'
// '<S101>' : 'SimModel0621_S4/Controler/PID Controller3/Reset Signal/Disabled'
// '<S102>' : 'SimModel0621_S4/Controler/PID Controller3/Saturation/Enabled'
// '<S103>' : 'SimModel0621_S4/Controler/PID Controller3/Saturation Fdbk/Disabled'
// '<S104>' : 'SimModel0621_S4/Controler/PID Controller3/Sum/Sum_PID'
// '<S105>' : 'SimModel0621_S4/Controler/PID Controller3/Sum Fdbk/Disabled'
// '<S106>' : 'SimModel0621_S4/Controler/PID Controller3/Tracking Mode/Disabled'
// '<S107>' : 'SimModel0621_S4/Controler/PID Controller3/Tracking Mode Sum/Passthrough'
// '<S108>' : 'SimModel0621_S4/Controler/PID Controller3/Tsamp - Integral/TsSignalSpecification'
// '<S109>' : 'SimModel0621_S4/Controler/PID Controller3/Tsamp - Ngain/Passthrough'
// '<S110>' : 'SimModel0621_S4/Controler/PID Controller3/postSat Signal/Forward_Path'
// '<S111>' : 'SimModel0621_S4/Controler/PID Controller3/preInt Signal/Internal PreInt'
// '<S112>' : 'SimModel0621_S4/Controler/PID Controller3/preSat Signal/Forward_Path'
#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'.
//
// Model version : 5.105
// Model version : 5.115
// 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
// Embedded hardware selection: Intel->x86-64 (Linux 64)
@@ -30,10 +30,10 @@ Controler::P Controler::rtP{
// '<S46>/Proportional Gain'
{
1,
1.0,
0.01,
3,
5.0
0.01,
10.0
},
// Variable: pid_heading
@@ -44,9 +44,9 @@ Controler::P Controler::rtP{
// '<S100>/Proportional Gain'
{
0.5,
0.01,
0.1,
10.0,
1.0,
5.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'.
//
// Model version : 5.105
// Model version : 5.115
// 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
// 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'.
//
// Model version : 5.105
// Model version : 5.115
// 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
// 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'.
//
// Model version : 5.105
// Model version : 5.115
// 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
// 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'.
//
// Model version : 5.105
// Model version : 5.115
// 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
// 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'.
//
// Model version : 5.105
// Model version : 5.115
// 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
// 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'.
//
// Model version : 5.105
// Model version : 5.115
// 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
// Embedded hardware selection: Intel->x86-64 (Linux 64)

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

@@ -7,9 +7,9 @@
//
// Code generated for Simulink model 'Controler'.
//
// Model version : 5.105
// Model version : 5.115
// 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
// Embedded hardware selection: Intel->x86-64 (Linux 64)