image-20240723143317956
| 功能 | 该模块包含了负载故障模块以及故障模型模块。负载故障模块 用于表示负载故障类型以及对应的故障参数(如:LoadFall负载掉落故障、LoadShift负载漂移故障、LoadLeak负载泄露故障);故障模型模块 用于计算由于模型故障(包括LoadFall负载掉落故障、LoadShift负载漂移故障、LoadLeak负载泄露故障)引起的质量和惯性矩的变化。 |
| 参数 | |
| uavMass | 无人机的总质量 |
| uavR | 无人机的某个特定参考半径或距离,用于计算移动质量的偏移。 |
| isLoadFall | bool布尔值,指示是否发生负载掉落故障。 |
| LoadFallParams | 数组,包含负载掉落故障的参数。 |
| isLoadShift | bool布尔值,指示是否发生负载漂移故障。 |
| LoadShiftParams | 数组,包含负载漂移故障的参数。 |
| isLoadLeak | bool布尔值,指示是否发生负载泄露故障。 |
| LoadLeakParams | 数组,包含负载泄露故障的参数。 |
| dcm | 方向余弦矩阵,用于将载荷移动引起的力转换到无人机坐标系中。 |
| uavlostMass | 方向余弦矩阵,用于将载荷移动引起的力转换到无人机坐标系中。 |
| uavlostJ | 无人机由于载荷掉落、移动或泄漏损失的惯性矩矩阵(3x3矩阵)。 |
| deltaM | 由于载荷移动引起的力矩变化(3x1向量)。 |
| 输入 | |
| 6DOF Bus1 | 将简易环境模型和刚体六自由度模型的输出封装在总线中。 |
| ModelParam.uavMass | 无人机的总质量。 |
| ModelParam.uavR | 无人机的某个特定参考半径或距离,用于计算移动质量的偏移。 |
| FaultIn | 故障输入,包括故障类型和故障参数。 |
| 输出 | |
| Fail Model Bus1 | 将uavMass,uavJ,deltaM ,uavR封装在总线中。 |
负载故障模块(内层)
image-20240723151204788
| 功能 | 负载故障模块 用于表示负载故障类型以及对应的故障参数。(如:LoadFall负载掉落故障、LoadShift负载漂移故障、LoadLeak负载泄露故障)inSlLInts的每一位,对应了inSlLFloats的两位数字,用于将故障参数传进来。 |
| 123452为负载掉落故障ID(1个故障参数,重量泄露比);123456为负载漂移故障ID(4个故障参数,重量泄露比,x,y,z的漂移因子);123457为负载泄露故障ID(2个故障参数,1个重量泄露比,1个泄露因子);注:如果没有新的故障注入进来,FaultParamsExtract会保持上一时刻的值。 |
| 输入 | |
| FaultIn | 故障输入,包括故障类型和故障参数。 |
| LoadFallFaultID | 负载掉落故障的唯一标识密钥 |
| LoadShiftFaultID | 负载漂移故障的唯一标识密钥 |
| LoadLeakFaultID | 负载泄露故障的唯一标识密钥 |
| 输出 | |
| LoadFaultParam | 将负载掉落,负载漂移,负载泄露故障参数(hasFault,FaultParam )封装在总线中。 |
FaultParamsExtract模块(内内层)
image-20240724165608231
具体参考**同目录下的FaultParamsExtract说明文档**