1.一种机器人笛卡尔空间的时间最优轨迹规划方法,其特征在于,包括以下步骤:S1、根据机器人本体的质量参数和运动参数,通过在机器人示教盒上对目标点 进行示教,两个目标点 和 之间构成笛卡尔空间直线路径 ;
S2、通过归一化因子 统一机器人笛卡尔空间直线路径 的位置向量 和姿态向量 ,从而生成用于实现位置和姿态统一规划的总路径长度 ;
具体包括:所述用于实现位置和姿态的统一规划的总路径长度的公式表示为:;
其中, 是机器人笛卡尔空间的位置向量, 是机器人笛卡尔空间的姿态向量,是归一化因子;
所述笛卡尔空间直线路径 的前三个分量为位置向量,其表示为, 后三个分量为姿态向量,其表示为
,归一化因子设定为 ,则 的总长度
,直线路径 上任意点 可以用总路径长度 来表示为:;
S3、结合机器人动力学驱动力矩方程、电机的转速和驱动力矩的约束条件,建立机器人笛卡尔空间的路径约束方程;
S4、在机器人笛卡尔空间的路径约束方程下,建立时间最优化轨迹规划的目标函数;
S5、根据机器人笛卡尔空间的路径约束方程来计算速度限制曲线,在速度限制曲线约束下,通过最大路径加速度的时间积分来得到最大的路径速度;
S6、沿着最大的路径速度进行时间积分从而生成时间最优轨迹。
2.根据权利要求1所述的一种机器人笛卡尔空间的时间最优轨迹规划方法,其特征在于:在步骤S1中,所述质量参数包括6个连杆的长度 、质量 、质心偏移量 和惯量 ,所述运动参数包括关节限位角 、关节最大速度 和最大驱动力矩 。
3.根据权利要求1所述的一种机器人笛卡尔空间的时间最优轨迹规划方法,其特征在于:在步骤S3中,所述机器人动力学驱动力矩方程表示为:;
其中, 是质量矩阵, 是科氏力和离心力, 是重力力矩, 是驱动力矩, 分别是关节角、速度和加速度向量。
4.根据权利要求3所述的一种机器人笛卡尔空间的时间最优轨迹规划方法,其特征在于:所述S3中建立机器人笛卡尔空间的路径约束方程,具体包括以下步骤:S31、通过机器人逆运动学并结合总路径长度 得到关于总路径长度 的机器人动力学驱动力矩方程;
S32、通过电机最大驱动力矩 ,建立机器人动力学驱动力矩约束方程;
S33、将机器人动力学驱动力矩约束方程转换为关于 相平面的多边形可行区域,该区域把机器人动力学驱动力矩约束方程转换为对路径速度 和路径加速度 的约束,所述路径速度 和路径加速度 的约束表示分别为:;
其中, 是驱动力矩 约束下的最大路径速度, 是驱动力矩 约束下的最大路径加速度, 是最大路径减速度;
S34、依据机器人驱动电机的最大速度,得到机器人关节最大速度 的限制,根据机器人关节最大速度 的限制,得到机器人最终的最大路径速度的约束为:;其中, 是最大路径速度, 是电机转速v约束下的最大路径速度。
5.根据权利要求4所述的一种机器人笛卡尔空间的时间最优轨迹规划方法,其特征在于:在步骤S4中,所述时间最优化轨迹规划的目标函数表示为:;
其中, 是轨迹的运动时间, 是路径速度。
6.根据权利要求5所述的一种机器人笛卡尔空间的时间最优轨迹规划方法,其特征在于:在步骤S5中,所述通过最大路径加速度的时间积分来得到最大的路径速度的公式表示为:;
其中, 是最大路径加速度。