Optimal Energy Consumption Trajectory Planning for Mobile Robot Based on Motion Control and Frequency Domain Analysis
-
摘要: 本文针对两轮自平衡可移动机器人, 提出了一种新的能耗最优运动轨迹规划方法.本文将轨迹规划与由轨迹跟踪控制器和机器人动力学方程组成的运动控制模型相结合, 基于期望轨迹与实际电机输入电压间的传递函数和能量在时域和频域上的对应关系, 通过频域分析的方法得到了具有明确机理表达的线性能耗模型, 并采用最小二乘线性回归法对模型参数进行辨识.对于能耗最优轨迹, 由全局路径规划得到的路径点作为局部轨迹规划的局部目标点, 通过一定的数学转换和参数求导, 可直接得到相邻两个局部目标点间的能耗最优运行轨迹和对应的运行时间.通过仿真实验证明了本文所提能耗模型的准确性和所得轨迹的能耗最优性.Abstract: In this paper, a new optimal trajectory planning algorithm to minimize energy consumption for two-wheeled self-balancing motion robot is proposed. The trajectory planning is combined with the motion control model composed of trajectory tracking controller and robot dynamics model, and based on the transfer function between the desired trajectory and actual motor input voltage and the corresponding relationship of energy in time domain and frequency domain, a linear energy consumption model with clear mechanism expression is obtained by frequency-domain analysis and the model parameters are identified by the least square linear regression method. For the optimal trajectory, select the way points obtained by global path planning as the local target points of the local trajectory planning, through a certain mathematical transformations and derivative of parameters, the optimal operational trajectory and operational time of each two target points are determined directly. Through simulation experiments, the accuracy of the proposed energy consumption model and minimum energy consumption of the obtained trajectory are verified.
-
Key words:
- Trajectory planning /
- minimum energy consumption /
- motion robot /
- frequency-domain analysis
1) 本文责任编委 贺威 -
图 1 机器人实际路径与期望路径对比图以及对应的控制器动态过程示意图
Fig. 1 The actual path of the robot is compared with the expected path and the controller dynamic process
图 2 两轮自平衡小车侧视图与俯视图
Fig. 2 The side view and top view of two-wheel self-balancing robot
图 3 本文采用的轨迹规划和控制系统体系结构
Fig. 3 Architecture of the mobile robot trajectory planning and control system in this paper
图 5 能耗模型验证集拟合效果误差图
Fig. 5 Modeling errors of energy consumption model in validation set
图 7 能耗最优期望轨迹与实际轨迹对比图
Fig. 7 Comparison diagram of the optimal energy consumption desired trajectory and actual trajectory
图 8 能耗最优期望轨迹与实际轨迹坐标误差图
Fig. 8 Coordinate error graph of the optimal energy consumption desired trajectory and actual trajectory
图 9 真实能耗与运行时间和轨迹圆心角关系图
Fig. 9 The relational graph of real energy consumption with running time and track circle angle
图 10 三种运行轨迹对比图
Fig. 10 Contrast f
下载:
