Summary of the invention
In order to overcome the deficiency of said method, the present invention proposes a kind of new object pose detection or the method for measurement of curved surface.Move by the control robot arm, the elastic probe that is contained in the arm end is well contacted with measured surface, only need the information of the contact force of collection wrist force sensor, stressed according to elastic probe and be out of shape mapping relations, carry out data processing through computing machine, just can realize the measurement of surface of the work and the detection of object pose.Content comprises: the object pose detection system that (1) is made up of robot, sextuple wrist force sensor, elastic probe and computing machine.(2) proposed sextuple wrist force sensor and elastic probe combination, utilized sextuple wrist force sensor information to determine the algorithm of surface of the work geometric shape or object pose and designed corresponding process software.
The technical solution adopted for the present invention to solve the technical problems is: a kind of contact type object pose measuring apparatus, form by robot, sensor, probe, computing machine, sextuple wrist force sensor is installed in the end of robot arm, elastic probe is installed on the sextuple wrist force sensor, sextuple wrist force sensor is linked to each other with force information capture card in the computing machine by data line, and robot is linked to each other with computing machine by control bus.
Described measurement mechanism is detected or the required information acquisition unit of measurement of curved surface by a sextuple wrist force sensor and an elastic probe constituent posture.
Described measurement mechanism, the pose of inspected object or curve form only need be gathered the sextuple contact force information of wrist force sensor, obtain the position of contact in tool coordinates system on probe end and the body surface by the mapping relations of sextuple contact force and probe deformations, and then obtain the spatial positional information of check point in basis coordinates system of robot on the object by coordinate transform.
Described measurement mechanism by the position coordinates that detects the body surface series of points that obtains, obtains the pose of testee or the geometric configuration on surface.
Described measurement mechanism can obtain the testee surface information at CCD gamma camera of the parallel installation of robot wrist, and the depth information of adding the resulting unique point of probe can improve the efficient of detection.
Described measurement mechanism, probe are the three dimensional elasticity rigid materials, contact with the testee surface flexible.Well contact with measured surface and move according to the sextuple contact force information control probe of wrist force sensor by the robots arm, realize detecting automatically.
Described measurement mechanism can be measured the object surfaces shape based on curved surface.
As shown in Figure 1, sextuple wrist force sensor 1 and elastic probe 2 are fixed on the wrist and the end of robot 5 successively.The information of sextuple wrist force sensor 1 acquisition probe and testee 3 contact forces, and pass in the computing machine 6 by data line 7, by processing to force information, as shown in Figure 2, can obtain the elastic deformation of probe end, thereby can determine that 1 P on the object is a coordinate among the OXYZ in tool coordinates, this coordinate can finally be learned in the basis coordinates system that be transformed into robot by manipulator motion.For improving detection speed, generally can a cameras view be installed by means of macroscopical place or wrist, only need the positional information of the unique point of probe measurement body surface, just can obtain object in the robot basis coordinates is attitude or obtain its surperficial geometric shape.
The position of spatial point generally needs two width of cloth images, determines with the intersection point of two projection lines.The method that the present invention proposes then can be subjected to force information can determine the position of spatial point with probe contact.
Compare with binocular vision, the present invention has fundamentally avoided because caused uncertainty of images match and error.After contact stressed determined, its coordinate in tool coordinates system just can obtain by simple calculating.Binocular vision then will be carried out images match earlier, and then asks the intersection point of projection line.Obviously the present invention has significantly reduced calculated amount, has improved detection speed.The present invention compares more simple and practical with other measurement with detection method.
Embodiment
As shown in Figure 1, sextuple wrist force sensor 1 and elastic probe 2 are fixed on the wrist and sextuple wrist force sensor 1 end of robot 5 successively.Testee 3 is placed on the worktable 4, the information of sextuple wrist force sensor 1 acquisition probe and testee 3 contact forces, and pass in the computing machine 6 by data line 7, by processing, can obtain probe at x, y to force information, z three is axial stressed, and around three moment.As shown in Figure 2, AO is the position that probe does not deform, the position after AB deforms when being the probe actual measurement.Physical characteristics according to probe, can obtain probe end prolong three elastic deformation Δ x, Δ y, Δ z, with the angle α of probe end tangent line and three coordinate axis, beta, gamma, thereby can determine that 1 P on the object is a coordinate among the OXYZ in tool coordinates, this coordinate can finally be learned in the basis coordinates system that be transformed into robot by manipulator motion.For improving detection speed, generally can a cameras view be installed by means of macroscopical place or wrist, only need the positional information of the unique point of probe measurement body surface, just can obtain object in the robot basis coordinates is attitude or obtain its surperficial geometric shape.
The invention belongs to accurate self-operated measuring unit, particularly robots arm, sextuple wrist power sensing and elastic probe detect the pose of measured workpiece surface geometry profile or object.This measurement mechanism has replaced traditional binocular vision detection method, its technical scheme is: the force information that is subjected to by probe and body surface contact point obtains the ideal coordinates of point in tool coordinates system on the object, and then try to achieve this coordinate in robot basis coordinates system by coordinate transform by the robot kinematics, the motion of information Control robot end by sextuple wrist force sensor then, probe is well contacted with measured surface and move, record the location coordinate information of body surface series of points, thereby determine pose or the surface geometry profile of object in basis coordinates system of robot.Also can be by means of single gamma camera observed objects surface information, survey the positional information of body surface unique point again with probe, thereby can generate the geometric configuration of measured surface fast or record the pose of object.This surface of the work geometric shape measuring or object pose detection method are simple, and calculated amount is little, and precision is higher.