一种机器人先逆时针再顺时针运动控制方法

摘要

本发明公开了一种机器人先逆时针再顺时针运动控制方法，该方法包括以下步骤：设定并输入多个机器人运动参数；计算机器人运动的第一圆心的坐标；计算机器人运动的第二圆心的坐标；计算第一圆心指向第二圆心的第一单位向量；计算第一单位向量与第二单位向量之间的夹角；计算机器人运动的第一转换点的坐标；计算机器人运动的第二转换点的坐标；计算由第一转换点指向第二转换点的第二单位向量；计算机器人运动的第一转角；计算机器人运动的第二转角；基于上述运动路径参数，对于机器人的先逆时针后顺时针运动进行控制。本发明结合机器人学知识，利用坐标旋转变换方法实现了对于机器人先逆时针再顺时针运动的控制，本发明简单而且有效。