专利汇可以提供一种机器人先顺时针再逆时针运动控制方法专利检索,专利查询,专利分析的服务。并且本 发明 公开了一种 机器人 先顺 时针 再逆时针运动控制方法,该方法包括以下步骤:设定并输入多个机器人运动参数;计算机器人运动的第一圆心的坐标;计算机器人运动的第二圆心的坐标;计算第一圆心指向第二圆心的第一单位向量;计算第一单位向量与第二单位向量之间的夹 角 ;计算机器人运动的第一转换点的坐标;计算机器人运动的第二转换点的坐标;计算由第一转换点指向第二转换点的第二单位向量;计算机器人运动的第一转角;计算机器人运动的第二转角;基于上述运动路径参数,对于机器人的先顺时针后逆时针运动进行控制。本发明结合机器人学知识,利用坐标旋转变换方法实现了对于机器人先逆时针再顺时针运动的控制,本发明简单而且有效。,下面是一种机器人先顺时针再逆时针运动控制方法专利的具体信息内容。
1.一种机器人先顺时针再逆时针运动控制方法,其特征在于,该方法包括以下步骤: 步骤S1:设定并输入多个机器人运动参数,所述运动参数至少包括:机器人运动初始点S坐标(xs, ys),机器人在初始点S处的初始方向单位向量Ps (pxs, Pys),机器人运动目标点G坐标(xg,yg),机器人在目标点G处的目标方向单位向量Pg (pxg,pyg),以及机器人容许的转弯半径R ; 步骤S2:基于初始点S、初始方向单位向量Ps和转弯半径R计算得到机器人从初始点S沿初始方向单位向量Ps以转弯半径R做顺时针绕第一圆心Os运动的第一圆心Os的坐标(Xos,yos); 步骤S3:基于目标点G、目标方向单位向量Pg和转弯半径R计算得到机器人以转弯半径R沿逆时针绕第二圆心Og运动以到达目标点G和目标方向单位向量Pg的第二圆心Og的坐标(xog, yog); 步骤S4:基于第一圆心Os和第二圆心Og的坐标计算得到由第一圆心Os指向第二圆心Og的第一单位向量Q (qx, qy); 步骤S5:基于第一圆心Os、第二圆心Og和转弯半径R计算得到第一单位向量Q与第二单位向量W之间的夹角Y ; 步骤S6:基于所述第一圆心Os、转弯半径R和第一单位向量Q计算得到机器人从绕第一圆心Os顺时针运动转为沿第二单位向量W方向作直线运动的第一转换点Ws的坐标(Xws,^ws); 步骤S7:基于所述第二圆心0g、转弯半径R和第一单位向量Q计算得到机器人从沿第二单位向量W方向直线运动转为绕第二圆心Og逆时针运动的第二转换点Wg的坐标(xwg,ywg); 步骤S8:计算得到由第一转换点Ws指向第二转换点Wg的第二单位向量W(wx, Wy);步骤S9:基于第一圆心Os、初始点S、第一转换点Ws计算得到机器人从初始点S顺时针绕第一圆心Os运动到第一转换点Ws转过的第一转角a s ; 步骤SlO:基于第二圆心0g、目标点G、第二转换点Wg计算得到机器人从第二转换点Wg沿逆时针绕第二圆心Og运动到目标点G转过的第二转角β g ; 步骤Sll:基于所述步骤S2-S10计算得到的运动路径参数,对于机器人的先顺时针后逆时针运动进行控制,其中,所述机器人先顺时针后逆时针的运动路径为:由初始点S以半径R绕第一圆心Os顺时针运动转过第一转角a s到达第一转换点Ws,由第一转换点Ws沿第二单位向量W方向直线运动到第二转换点Wg,由第二转换点Wg以转弯半径R绕第二圆心Og逆时针运动转过第二转角Pg即到达目标点G。
2.根据权利要求1所述的方法,其特征在于,所述步骤S2具体为:先将初始方向单位向量Ps顺时针旋转90度,然后与转弯半径R相乘,再将相乘结果与初始点S坐标相加即得第一圆心Os的坐标。
3.根据权利要求1所述的方法,其特征在于,所述步骤S3具体为:先将目标方向单位向量Pg逆时针旋转90度,然后与转弯半径R相乘,再将相乘结果与目标点G的坐标相加即得第二圆心Og的坐标。
4.根据权利要求1所述的方法,其特征在于,所述步骤S4具体为:用第二圆心Og的坐标减去第一圆心Os的坐标,再将相减结果除以第一圆心Os和第二圆心Og两点间的长度值即得第一单位向量Q。
5.根据权利要求1所述的方法,其特征在于,所述步骤S5具体为:用2乘以R除以第一圆心Os和第二圆心Og两点间的长度值,再将计算结果进行反正弦即得夹角Y。
6.根据权利要求1所述的方法,其特征在于,所述步骤S6具体为:先将第一单位向量Q逆时针旋转(90-gamma)度,然后与转弯半径R相乘,再将相乘结果与第一圆心Os的坐标相加即得第一转换点的Ws坐标。
7.根据权利要求1所述的方法,其特征在于,所述步骤S7具体为:先将第一单位向量Q顺时针旋转(90+gamma)度,然后与转弯半径R相乘,再将相乘结果与第二圆心Og的坐标相加即得第二转换点Wg的坐标。
8.根据权利要求1所述的方法,其特征在于,所述步骤S8具体为:用第二转换点Wg的坐标减去第一转换点Ws的坐标,再将相减结果除以第一转换点Ws和第二转换点Wg两点间的长度值即得第二单位向量W。
9.根据权利要求1所述的方法,其特征在于,所述步骤S9进一步包括以下步骤: 步骤S91:计算第一圆心Os指向初始点S的第一向量MS ; 步骤S92:计算第一圆心Os指向第一转换点Ws的第二向量NS ; 步骤S93:用反余弦求取第一向量MS和第二向量NS之间的夹角α ; 步骤S94:判断从初始点S顺时针绕第一圆心Os到达第一转换点Ws转过的第一转角a s是否大于180度,如果a s小于等于180度,则令a s等于α,否则令a s等于2 π - α。
10.根据权利要求1所述的方法,其特征在于,所述步骤SlO进一步包括以下步骤: 步骤SlOl:计算第二圆心Og指向目标点G的第三向量MG ; 步骤S102:计算第二圆心Og指向第二转换点Wg的第四向量NG ; 步骤S103:用反余弦求取第三向量MG和第四向量NG之间的夹角β ; 步骤S104:判断从第二转换点Wg逆时针绕第二圆心Og运动到目标点G转过的第二转角β g是否大于180度,如果β g小于等于180度,则令β g等于β,否则令β g等于2 - β。
标题 | 发布/更新时间 | 阅读量 |
---|---|---|
可顺时针和逆时针插入使用的皮带 | 2020-05-11 | 727 |
一种机器人先顺时针再逆时针运动控制方法 | 2020-05-11 | 651 |
顺时针双环平面交叉口设计方案 | 2020-05-12 | 819 |
一种时针弯折的时钟 | 2020-05-11 | 595 |
一种抗拉顺时针方向绞合信号电缆 | 2020-05-13 | 549 |
一种抗拉逆时针方向绞合综合线缆 | 2020-05-13 | 223 |
一种机器人逆时针运动控制方法 | 2020-05-13 | 860 |
一种实现屏幕顺时针270度旋转的系统 | 2020-05-12 | 424 |
多功能盘式时针 | 2020-05-13 | 219 |
双时针钟表 | 2020-05-11 | 209 |
高效检索全球专利专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。
我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。
专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。