跳转到内容

UBot Odometry Sensor Data

C++
FUBotOdometrySensorData
模块
UBotSensor · UBotSensor 0.1.1
节点
Break · Make
头文件
Source/UBotSensor/Public/UBotSensorTypes.h

一次里程计采样:帧头、坐标系名、相对起点的位姿、本地坐标系下的速度和协方差。

字段类型蓝图说明
HeaderHeaderUBot Frame Header结构体只读帧头,含 Valid 和 Status。
Odometry Frame IdOdometryFrameIdString只读里程计坐标系名。
Child Frame IdChildFrameIdString只读被跟踪坐标系名。
Position MetersPositionMetersVector只读被跟踪组件相对起点的位置,单位 m,轴向取起点时的朝向。
Orientation QuaternionOrientationQuaternionQuat结构体只读被跟踪组件相对起点的朝向。
Linear Velocity Local Meters Per SecondLinearVelocityLocalMetersPerSecondVector只读被跟踪组件本地坐标系下的线速度,单位 m/s。
Angular Velocity Local Rad Per SecondAngularVelocityLocalRadPerSecondVector只读被跟踪组件本地坐标系下的角速度,单位 rad/s。
Pose CovariancePoseCovarianceFloat (double)数组只读位姿协方差,36 个数(6×6 对角矩阵):下标 0、7、14 是位置方差(m²),21、28、35 是朝向方差(rad²)。只由白噪声参数算出。
Twist CovarianceTwistCovarianceFloat (double)数组只读速度协方差,36 个数(6×6 对角矩阵):下标 0、7、14 是线速度方差((m/s)²),21、28、35 是角速度方差((rad/s)²)。
Has VelocitybHasVelocityBoolean只读速度字段是否有值,只有 Valid 样本为 true。

拆分结构体 · Break:FUBotOdometrySensorData

把 UBot Odometry Sensor Data 拆成帧头、坐标系名、位姿、本地速度、协方差和 Has Velocity。

引脚方向类型
UBot Odometry Sensor Data输入UBot Odometry Sensor Data结构体
Header输出UBot Frame Header结构体
Odometry Frame Id输出String
Child Frame Id高级输出String
Position Meters高级输出Vector
Orientation Quaternion高级输出Quat结构体
Linear Velocity Local Meters Per Second高级输出Vector
Angular Velocity Local Rad Per Second高级输出Vector
Pose Covariance高级输出Float (double)数组
Twist Covariance高级输出Float (double)数组
Has Velocity高级bHasVelocity输出Boolean

构造结构体 · Make:FUBotOdometrySensorData

用各字段组装一个 UBot Odometry Sensor Data。

引脚方向类型
UBot Odometry Sensor Data输出UBot Odometry Sensor Data结构体