本发明属于机器人打磨技术领域,尤其涉及一种机器人打磨路径的规划方法。
背景技术:
目前,在铸件打磨领域,主要利用机器人带工具对铸件浇冒口及飞边毛刺进行打磨,在实际作业过程中,经常会遇到毛刺向内并覆盖整个轨迹的情况,为识别打磨路径造成困扰,尤其是铸件存在圆形结构部分时,尤其容易发生此类情况,即毛刺向内,覆盖内圆的边缘,由于铸造工艺的不同,毛刺覆盖内圆的位置和面积多有不同,存在一定的随机性,对于较小的圆形结构甚至存在全部覆盖的情况,给机器人准确识别打磨路径带来干扰,为打磨作业带来困难。
技术实现要素:
本发明的目的就是提供一种基于机器人的铸件圆形结构打磨路径规划方法,用以解决目前打磨铸件圆形结构部分时无法准确判断准确位置,给打磨路径带来干扰的技术问题。
本发明的具体技术方案如下:
一种基于机器人的铸件圆形结构打磨路径规划方法,包括以下步骤:
s1:将激光传感器安装在机器人的机械手六轴法兰前端,激光传感器的垂直方向与机械手的z轴重合。
s2:机器人与激光传感器进行坐标系标定,并建立通讯;
s3:机器人进行铸件标准件待打磨圆形结构特征位置进行机器人行走轨迹预设,保证待打磨位置出现在激光的范围内;
s4:待打磨铸件进入打磨区域后,机器人携激光传感器按照预设的轨迹对待打磨铸件的圆形结构进行扫描,得到圆形结构扫描位置数据;
s5:计算铸件圆形结构每个扫描位置的坐标值,将坐标值通讯给机器人,机器人根据数据重新规划打磨路径,并根据路径进行实际打磨。
进一步的,所述步骤s4中,激光传感器的扫描位置即为圆形结构的若干个边缘点,激光传感器进行扫描时,机械手存在z轴方向的旋转,激光传感器的激光线方向坐标分解到机械手的x轴和y轴方向上,激光线上的值为l,机械手z轴的旋转角度为a,则激光线方向分解到机械手x轴和y轴方向上的坐标分别是(l*cosa,l*sina),已知激光线方向在机械手x轴和y轴方向的分量的情况下,圆形结构的每个边缘点在机械手坐标系下的坐标为:
(xr+l*cosa,yr+l*sina,zr+zray)
其中,xr、yr、zr为机器人坐标,zray是激光传感器的z轴坐标值。
本发明针对铸造件圆形结构打磨路径规划,弥补了机器人打磨铸造件圆形构造设定固定打磨轨迹带来的问题,通过激光扫描结合固定打磨轨迹,对位置信息作出准确判断,保证打磨质量的同时提高打磨效率。
附图说明
图1为本发明的流程框图。
图2为本发明的硬件示意图。
具体实施方式
接下来就结合实施例和附图对本发明作详细说明
实施例
如图1和图2所示的一种基于机器人的铸件圆形结构打磨路径规划方法,包括以下步骤:
s1:将激光传感器2安装在机器人1的机械手六轴法兰前端,激光传感器的垂直方向与机械手的z轴重合;
s2:机器人坐标系w与激光传感器坐标系c1进行坐标系标定,并建立通讯;
s3:机器人进行铸件标准件待打磨圆形结构特征位置进行机器人行走轨迹预设,保证待打磨位置出现在激光的范围内;
s4:待打磨铸件3进入打磨区域后,机器人携激光传感器按照预设的轨迹对待打磨铸件的圆形结构4进行扫描,得到圆形结构扫描位置数据,激光传感器的扫描位置即为圆形结构的若干个边缘点,激光传感器进行扫描时,机械手存在z轴方向的旋转,激光传感器的激光线方向坐标分解到机械手的x轴和y轴方向上,激光线上的值为l,机械手z轴的旋转角度为a,则激光线方向分解到机械手x轴和y轴方向上的坐标分别是(l*cosa,l*sina),已知激光线方向在机械手x轴和y轴方向的分量的情况下,圆形结构的每个边缘点在机械手坐标系下的坐标为:
(xr+l*cosa,yr+l*sina,zr+zray)
其中,xr、yr、zr为机器人坐标,zray是激光传感器的z轴坐标值;
s5:计算铸件圆形结构每个扫描位置的坐标值,将坐标值通讯给机器人,机器人根据数据重新规划打磨路径,并根据路径进行实际打磨。
1.一种基于机器人的铸件圆形结构打磨路径规划方法,其特征是:包括以下步骤:
s1:将激光传感器安装在机器人的机械手六轴法兰前端,激光传感器的垂直方向与机械手的z轴重合;
s2:机器人与激光传感器进行坐标系标定,并建立通讯;
s3:机器人进行铸件标准件待打磨圆形结构特征位置进行机器人行走轨迹预设,保证待打磨位置出现在激光的范围内;
s4:待打磨铸件进入打磨区域后,机器人携激光传感器按照预设的轨迹对待打磨铸件的圆形结构进行扫描,得到圆形结构扫描位置数据;
s5:计算铸件圆形结构每个扫描位置的坐标值,将坐标值通讯给机器人,机器人根据数据重新规划打磨路径,并根据路径进行实际打磨。
2.根据权利要求1所述的一种基于机器人的铸件圆形结构打磨路径规划方法,其特征是:所述步骤s4中,激光传感器的扫描位置即为圆形结构的若干个边缘点,激光传感器进行扫描时,机械手存在z轴方向的旋转,激光传感器的激光线方向坐标分解到机械手的x轴和y轴方向上,激光线上的值为l,机械手z轴的旋转角度为a,则激光线方向分解到机械手x轴和y轴方向上的坐标分别是(l*cosa,l*sina),已知激光线方向在机械手x轴和y轴方向的分量的情况下,圆形结构的每个边缘点在机械手坐标系下的坐标为:
(xr+l*cosa,yr+l*sina,zr+zray)
其中,xr、yr、zr为机器人坐标,zray是激光传感器的z轴坐标值。