#判断机械臂运动到目标点的方法

最新推荐文章于 2023-03-22 14:40:42 发布

weixin_45163234

最新推荐文章于 2023-03-22 14:40:42 发布

阅读量1.3k

点赞数 1

分类专栏： 123 文章标签：判断机械臂到达目的点

本文链接：https://blog.csdn.net/weixin_45163234/article/details/91126484

版权

123 专栏收录该内容

1 篇文章 0 订阅

订阅专栏

#判断机械臂运动到目标点的方法
def isMoveOver(xx,yy,zz,error_value):
‘’’
描述：判断机械臂是都运动到目标点的方法
参数：
xx:机械臂目标位置x轴的值
yy:机械臂目标位置y轴的值
zz:机械臂目标位置z轴的值
error_value:机械臂目标位置和实际位置的偏差值
‘’’
global x
global y
global z
#循环看机械臂的实时位置是否到目标位置，如果到目标位置则退出循环
while True:
time.sleep(0.05)
#机械臂理论坐标误差在0.5mm以内，实际误差在2mm以内
if (x >= xx - error_value and x <= xx + error_value) and (y >= yy - error_value and y <= yy + error_value) and (z >= zz - error_value and z <= zz + error_value):
break