概述
kino_replan_fsm.cpp订阅实时定位和目标点信息,每隔0.01s执行一次状态机,进行状态切换;每隔0.05s执行一次碰撞检测,按需进行重新规划。核心为执行变量exec_state_
主要函数及作用
- KinoReplanFSM::init
输入:句柄
作用:launch参数读取、定时器声明、pub声明、sub声明
- KinoReplanFSM::waypointCallback
作用:孤立目标点回调函数:设置目标点位置、速度并进行其球形的可视化、执行状态变量更新
- KinoReplanFSM::odometryCallback
作用:定位回调函数:位置、航向、三轴速度、标志位置true(表明接受到定位数据)
- KinoReplanFSM::changeFSMExecState
作用:按照给定参数进行执行状态变量的更新,并打印输出
5.KinoReplanFSM::printFSMExecState
作用:打印当前执行状态变量的数值
- KinoReplanFSM::execFSMCallback

最低0.47元/天 解锁文章
3025

被折叠的 条评论
为什么被折叠?



