[发明专利]一种上下料机械手安全区快速在线示教方法

摘要

本发明公开了一种上下料机械手安全区快速在线示教方法，包括根据X轴和Z轴的移动轨迹进行坐标示教，保存X轴和Z轴对应的示教点；基于X轴的示教点选择两个示教点保存为左极限x1和右极限x2；基于Z轴的示教点选择两个示教点保存为上极限z1和下极限z2；以Y轴的整个移动轨迹为安全移动范围，基于左极限x1、右极限x2、上极限z1和下极限z2，形成封闭的立方体作为机械手运动的安全区域；对得到的所述安全区域进行合法性检测，若检测合格则确定为安全区域；否则丢弃本次得到的所述安全区域，并返回重新设置。本发明无需人工输入运动极限坐标，实现在线示教，降低安全区设置复杂度。