摘要
An end-effector for a flexible drilling robot is designed, and a novel four-point algorithm of normal attitude regulation for this end-effector is presented. Four non-coplanar points can define a unique sphere tangent to them in spatial geometry, and the center point of the sphere and the radius can be calculated. The shape of a workpiece surface in the machining area is approximately regarded as such a sphere. A vector from the machining point to the center point is thus approximately regarded as a normal vector to the workpiece surface. By this principle, the algorithm first measures four coordinates on the curve in the drilling region using four sensors and calculates the normal vector at the drilling point, then calculates the error between the normal vector and the axis of the spindle. According to this error, the algorithm further figures out the angles of two revolving axes on the end- effector and the displacements of three linear axes on the robot main body, thus it implements the function of adjusting the spindle to be perpendicular to the curve at the drilling point. Simulation results of two kinds of curved surfaces show that accuracy and efficiency can be realized using the proposed algorithm.
设计了一种曲面柔性制孔机器人末端执行器,并针对该末端执行器提出了一种法向姿态调整的新算法.空间不共面四点可以确定一个与之相切的球面,求出该球面的半径及球心位置,以该球面近似代表制孔点区域的曲面,联结制孔点与该球面球心的矢量即可近似代表制孔点曲面的法矢量.根据这一原理,该算法首先用4个位移传感器测量出曲面上制孔区域内4个点的坐标,并由此计算出制孔位置的法向矢量,然后计算出此法向矢量与末端执行器上电主轴的轴线矢量的误差.根据该误差,进一步计算出末端执行器上2个旋转轴的旋转角度及制孔机器人另外3个直线移动方向的移动距离,从而实现调整主轴在制孔点与曲面垂直的功能.针对2种类型曲面的仿真结果表明,根据该算法可以实现较高的调整精度和效率.
基金
National Science and Technology Major Project(No.2009ZX04014-023)
