Content of the invention
The goal of the invention of the present invention is to provide a kind of articulated robot dynamic property evaluation system, to solve existing skill
Between art cannot be for produced displacement error in the kinematic parameter of articulated robot and articulated robot moving process
Relation provides intuitively data, leads to the problem of the dynamic property of articulated robot of can not testing and assessing exactly.
According to embodiments of the invention, there is provided a kind of articulated robot dynamic property evaluation system, described multi-joint
Be provided with robot platform below robot, described robot platform is provided with robot controller, described robot controller with
Described articulated robot connects, and described system includes network interface camera, optical target and industrial computer;
Described network interface camera is connected with described industrial computer, for the collection image being sent according to the described industrial computer receiving
Instruction, gathers the image of described optical target, sends described image to described industrial computer afterwards;
Described optical target is fixed on the end of described articulated robot, surveys for being located in described articulated robot
During examination position, provide labelling point for described articulated robot;Described test position is located at the surface of described network interface camera, institute
State articulated robot be located at described test position when, described optical target be located at described network interface camera camera calibration visual field
Interior, the target surface of described optical target is relative and parallel with the minute surface of the camera lens of described network interface camera;
Described industrial computer one end is connected with described robot controller, and the other end is connected with described network interface camera;Described work
Control machine is used for before testing, when described articulated robot is located at described test position, sends collection figure to described network interface camera
As instruction is to control the image of optical target described in described network interface collected by camera, receive according to described network interface collected by camera
The image of optical target, and choose a pixel in described image as labelling point, and according to described labelling point described
Setting coordinate reference coordinate in the camera calibration visual field of network interface camera;
Described articulated robot completes multiple test periods under the control of described robot controller, described industrial computer
For within each described test period, when described articulated robot is located at described test position, according to receive
The collection image request that robot controller sends, sends collection image command to control described network interface phase to described network interface camera
Machine gathers the image of described optical target, receives the image of described network interface collected by camera, obtains institute in each described test period
State changing coordinates in the camera calibration visual field of described network interface camera for the labelling point, calculate described reference coordinate and work as with each described
Generic pixel coordinate difference between front coordinate;Thus according in the plurality of test period, described kinematic parameter and described coordinate
Corresponding relation between difference, the dynamic property of described articulated robot of testing and assessing;
Described industrial computer sends kinematic parameter control instruction in test to described robot controller, makes described multi-joint
Under the control of described robot controller, the kinematic parameter according to setting completes the plurality of test period, each for robot
In described test period, described articulated robot from original position through set path movement to described test position, then warp
Cross set path and return described original position from described test position;In each described test period, described robot controller
Kinematic parameter different.
When described reference coordinate is that certain described articulated robot is located at described test position, described labelling point is described
An initial coordinate in the camera calibration visual field of network interface camera, or, described reference coordinate is that described articulated robot is many
Secondary move to described test position when, described labelling point corresponding multiple seat in the camera calibration visual field of described network interface camera
Target meansigma methodss.
The end of described articulated robot is fixed with keyset, and described optical target is rigidly connected with described keyset.
Described optical target includes:Housing, the white LED light source plate located at described enclosure interior, open located at described housing
The diffuse-reflectance plate at mouthful end and located at described shell nozzle end and be located at the glass target target outside described diffuse-reflectance plate.
Parallel and spaced a plurality of black scale is printed with described glass target target, described a plurality of black scale
Precision is different;Full accuracy in described precision is higher than the nominal full accuracy of described articulated robot.
Described white LED light source plate by described diffuse-reflectance plate shape uniformly illumination, through the glass of described glass target target
After glass medium, with described glass target target on black scale to form background in the camera calibration visual field of described network interface camera bright
Spend consistent target picture.
In described industrial computer, parallel running has vision localization software and robot controller software;
Described vision localization software passes through ethernet communication through the second network interface with described robot controller, for receiving
State the collection image request that robot controller sends;
Described vision localization software passes through ethernet communication through the first network interface with described network interface camera, for according to described machine
The collection image request that device people's controller sends, sends collection image command to described network interface camera, and receives described network interface
The image of collected by camera;
Described robot controller software passes through ethernet communication through described second network interface with described robot controller, uses
In to described robot controller transmission kinematic parameter control instruction.
Described network interface camera is fixed in detection platform, and described detection platform is plane marble board.
Movement velocity, motor pattern, path point position and motion that described kinematic parameter includes described articulated robot add
Speed.
From above technical scheme, the articulated robot dynamic property evaluation system of the present invention, including network interface camera,
Optical target and industrial computer;Build camera calibration visual field using network interface camera cooperation industrial computer, at the end of articulated robot
End is rigidly connected optical target, by record articulated robot under different motion parameter optical target in camera calibration visual field
Repeat the changes in coordinates of mobile generation, produced by kinematic parameter and the articulated robot moving process of articulated robot
Coordinate difference between relation provide intuitively data, with the dynamic property of articulated robot of testing and assessing it is possible to by repeating
Property test data, the optimum occupation mode of analysis articulated robot, thus for during follow-up articulated robot motion
Path planning and speed controlling provide and instruct.
Specific embodiment
Below in conjunction with the accompanying drawing in the embodiment of the present invention, the technical scheme in the embodiment of the present invention is carried out clear, complete
Whole description is it is clear that described embodiment is only a part of embodiment of the present invention, rather than whole embodiments.It is based on
Embodiment in the present invention, it is every other that those of ordinary skill in the art are obtained under the premise of not making creative work
Embodiment, broadly falls into the scope of protection of the invention.
Refer to Fig. 1, the present invention provides a kind of articulated robot dynamic property evaluation system, described articulated robot
It is provided with robot platform 1, robot platform 1 is provided with robot controller 2, robot controller 2 and multi-joint machine below 3
People 3 connects, and robot controller 2 is used for controlling the motion of articulated robot 3.
The articulated robot dynamic property evaluation system of the present invention, the adaptation to the board environment of articulated robot 3
Property strong, as long as articulated robot 3 is seated on robot platform 1, you can the articulated robot dynamic of the arrangement present invention
Energy evaluation system, tests to the 3 of articulated robot dynamic property.
Below the concrete composition of articulated robot dynamic property evaluation system provided in an embodiment of the present invention is said
Bright.
In the present embodiment, the articulated robot dynamic property evaluation system of the present invention includes:
Detection platform 4, camera opticses support 5, network interface camera 6, optical target 7 and industrial computer 8.
Wherein, detection platform 4 can be on robot platform 1, for carrying camera opticses support 5.
Further, detection platform 4 can be small-sized marble board or the higher optics of other flatnesses is put down
Platform, detection platform 4 has higher flatness, can improve number when the dynamic property to articulated robot 3 is tested
According to accuracy.
Camera opticses support 5, in detection platform 4, is used for fixing network interface camera 6.
Camera opticses support 5 can include the montant being fixed in detection platform 4 and the cross bar being connected with montant, montant
It is connected by a fixed cover between cross bar, cross bar one end is used for fixing network interface camera 6.
To adjust the height of cross bar, and then the height of network interface camera 6 can be adjusted by adjusting height on montant for the fixed cover
Degree.The length of fixed cover can be stretched out by adjusting cross bar, to adjust network interface camera 6 position in the horizontal direction.
Network interface camera 6 is fixed on camera opticses support 5, and is connected with industrial computer 8, for according to the industrial computer receiving
The collection image command of 8 transmissions, the image of collection optical target 7, afterwards image is sent to industrial computer 8.
Network interface camera 6 is usually million grades of pixels, with the camera lens that configuration is matched with high-resolution often, and network interface phase
Popularization is compared in the use of the Ethernet interface of machine 6 and Data Transmission Feature is preferable, and therefore cost performance is higher.
Optical target 7 is fixed on the end of articulated robot 3, for articulated robot 3 be located at test position when,
There is provided labelling point for articulated robot 3.
Test position is located at the surface of network interface camera 6, when articulated robot 3 is located at test position, optical target 7
In the camera calibration visual field of network interface camera 6, the target surface of optical target 7 is relative with the minute surface of the camera lens of network interface camera 6 and parallel.
Specifically, the end of articulated robot 3 is fixed with keyset 30, and optical target 7 is rigidly connected with keyset 30.
Specifically, optical target 7 includes:Housing 71, the white LED light source plate 72 within located at housing 71, located at housing
The diffuse-reflectance plate 73 of 71 openings and located at housing 71 opening and be located at the glass target target 74 in diffuse-reflectance plate 73 outside.
Wherein, the material of housing 71 can be aluminum.
Parallel and spaced a plurality of black scale is printed with glass target target 74, the precision of a plurality of black scale is each
Differ;Full accuracy in precision can be higher than the nominal full accuracy of articulated robot.
In the present embodiment, the full accuracy in precision can be 10 μm, and black scale is included with 10 μm as full accuracy
Target, to be consistent with robot product highest repetitive positioning accuracy of the same trade, and precision of loweing line by line, adapt to different
Required precision, can select the black scale of corresponding precision to build labelling point according to actual needs.
White LED light source plate 72 can form uniform illumination, and the glass through glass target target 74 by diffuse-reflectance plate 73
After medium, to form background luminance in the camera calibration visual field of network interface camera 6 consistent with the black scale on glass target target 74,
And the extremely strong target picture of contrast, thus be conducive to the seizure of image and the structure of succeeding marker point and acquisition.
Because optical target 7 is to be imaged in the camera calibration visual field of network interface camera 6 in the way of active light, therefore it is imaged
It is not easily susceptible to ambient stray light or the impact of light and shade field, there is certain luminous environment adaptability.
Industrial computer 8 one end is connected with robot controller 2, and the other end is connected with network interface camera 6, by Ethernet realize with
Data interaction between robot controller 2 and network interface camera 6.
Industrial computer 8 is used for before testing, when articulated robot 3 is located at test position, sends collection figure to network interface camera 6
As instruction is to control network interface camera 6 to gather the image of optical target 7, receive the figure of the optical target 7 according to network interface camera 6 collection
Picture, and choose a pixel in image as labelling point, and according to labelling point in the camera calibration visual field of network interface camera 6
Setting coordinate reference coordinate.
Articulated robot 3 completes multiple test periods under the control of robot controller 2, and industrial computer 8 is used for every
In individual test period, when articulated robot 3 is located at test position, the collection that the robot controller 2 according to receiving sends
Image request, sends collection image command to control network interface camera 6 to gather the image of optical target 7 to network interface camera 6, receives net
The image of mouth camera 6 collection, obtains each test period internal labeling point current seat in the camera calibration visual field of network interface camera 6
Mark, the generic pixel coordinate difference between calculating benchmark coordinate and each changing coordinates;Thus according in multiple test periods, moving
Corresponding relation between parameter and coordinate difference, the dynamic property of test and appraisal articulated robot.
Meanwhile, industrial computer 8 sends kinematic parameter control instruction in test to robot controller 2, makes multi-joint machine
Under the control of robot controller 2, the kinematic parameter according to setting completes multiple test periods to people 3.
In each test period, articulated robot 3 from original position through set path movement to test position, then warp
Cross set path from test position correcting action;In each test period, the kinematic parameter of robot controller 2 is different.
During generic pixel coordinate difference between calculating benchmark coordinate and each changing coordinates, the establishing method of reference coordinate
Calculate demand depending on specific potential difference, can have multiple setting means.
In the present embodiment, when reference coordinate can be that certain articulated robot 3 is located at test position, labelling point is in net
An initial coordinate in the camera calibration visual field of mouth camera 6 or articulated robot move to test position more than 3 time
When, the meansigma methodss of labelling point corresponding multiple coordinate in the camera calibration visual field of network interface camera 6, in addition it is also possible to according to it
His rule settings reference coordinate.Wherein it is possible to according to actual needs, choose labelling point in the black scale of corresponding precision.
Specifically, in industrial computer 8, parallel running has vision localization software 83 and robot controller software 84.
Wherein, vision localization software 83 passes through ethernet communication through the second network interface 82 and robot controller 2, for receiving
The collection image request that robot controller 2 sends.
Vision localization software 83 passes through ethernet communication through the first network interface 81 and network interface camera 6, for according to robot control
The collection image request that device 2 processed sends, sends collection image command to network interface camera 6, and the figure receiving network interface camera 6 collection
Picture.
Robot controller software 84 passes through ethernet communication through the second network interface 82 and robot controller 2, for machine
Device people's controller 2 sends kinematic parameter control instruction.
The articulated robot dynamic property evaluation system of the present invention, can be in the following manner to network interface in actual erection
Camera 6 is adjusted.
First, in articulated robot 3 end, optical target 7 is fixed by keyset 30, robot platform 1 is placed
Detection platform 4, and fix network interface camera 6 using the camera opticses support 5 having certain vertical precision with detection platform 4, adjust many
The orientation of articulated robot 3 end, makes optical target 7 enter the field of view center of network interface camera 6.
Then, the aperture of adjustment network interface camera 6 and focal length, and network interface camera 6 and optics are adjusted by camera opticses support 5
The distance of target 7, adjusts the brightness of optical target 7 so that optical target 7 is in the camera calibration visual field of network interface camera 6 simultaneously
Blur-free imaging.
Afterwards, available electronic horizontal ruler does horizontal reference mark in the plane of the detection platform 4 below network interface camera 6
Fixed, then electronic horizontal ruler is placed on keyset 30 back side, the attitude of adjustment articulated robot 3 is so that optical target 7 and inspection
Survey platform 4 and keep level.So far, the primary optical axis of network interface camera 6 and the perpendicularity of optical target 7 have reached mechanical precision.
Finally, the focal length then to network interface camera 6 and aperture are finely adjusted, and on prominent optical target 7, contrast is obvious
Eigenvector.Because detection platform 4 has higher flatness, and the prudent of itself can effectively absorb articulated robot 3
The micro-vibration that during high-speed mobile, detection platform 4 caused is it is ensured that the picture remains stationary of network interface camera 6.
The work process of the articulated robot dynamic property evaluation system of the present invention is as follows:
Before test, need to build, using optical target 7, the labelling point representing articulated robot 3 position, and according to labelling
Setting coordinate reference coordinate in the camera calibration visual field of network interface camera 6 for the point, is specifically as follows:
Control articulated robot 3 mobile to test position by robot controller 2, fixed by the vision of industrial computer 8
Position software 83, sends collection image command to network interface camera 6, to control network interface camera 6 to gather the image of optical target 7.
The collection image command that network interface camera 6 sends according to industrial computer 8, completes the collection of the image to optical target 7, and
Image is sent to the vision localization software 83 of industrial computer 8.
After the vision localization software 83 of industrial computer 8 receives the image of network interface camera 6 collection, choose a pixel in image
Point as labelling point, reference coordinate can be set as certain articulated robot 3 be located at test position when, labelling point is in network interface phase
An initial coordinate in the camera calibration visual field of machine 6 is it is also possible to be set as that articulated robot moves to test position more than 3 time
When, the meansigma methodss of labelling point corresponding multiple coordinate in the camera calibration visual field of network interface camera 6.
It should be noted that during building labelling point, corresponding precision on optical target 7 can be chosen according to actual needs
Black scale, such as precision is 10 μm of black scale, then adjusts lens focus and the aperture of network interface camera 6, adjusts network interface
The parameter such as the exposure of camera 6 and gain is it is ensured that the precision of optical target 7 is 10 μm of black scale single pixel on image
Blur-free imaging in category, can choose a pixel in image afterwards as labelling point.
After representing the labelling point of articulated robot 3 position using optical target 7 structure, just can pass through the present invention's
Articulated robot dynamic property evaluation system, tests and assesses to the dynamic property of articulated robot 3.
During test, by the robot controller software 84 of industrial computer 8, send kinematic parameter control to robot controller 2
System instruction, makes articulated robot 3 under the control of robot controller 2, and the kinematic parameter according to setting completes multiple tests
Cycle.
Specifically, in each test period, articulated robot 3 from original position through set path movement to test position
Put, then through set path from test position correcting action, thus completing one cycle.
Wherein, kinematic parameter can include movement velocity, motor pattern, path point position and the motion of articulated robot 3
Acceleration etc., and can be within each test period, by the robot controller software 84 of industrial computer 8, to robot control
Device 2 processed sends different kinematic parameter control instructions, makes articulated robot 3 under the control of robot controller 2, according to setting
Fixed kinematic parameter completes multiple test periods.
Further, within each test period, when articulated robot 3 is located at test position, robot controller 2 can be to
The vision localization software 83 of industrial computer 8 sends collection image request.
The collection image request that the vision localization software 83 of industrial computer 8 sends according to the robot controller 2 receiving, to
Network interface camera 6 sends collection image command.
Network interface camera 6, after the collection image command that the vision localization software 83 receiving industrial computer 8 sends, gathers optics
The image of target 7, and image is sent to the vision localization software 83 of industrial computer 8.
After the vision localization software 83 of industrial computer 8 receives the image of network interface camera 6 collection, obtain in each test period,
Changing coordinates in the camera calibration visual field of network interface camera 6 for the labelling point, and between calculating benchmark coordinate and each changing coordinates
Generic pixel coordinate difference, thus being produced by kinematic parameter and articulated robot 3 moving process of articulated robot 3
Coordinate difference between relation intuitively data is provided.Can by the data of reperformance test, according in multiple test periods,
Corresponding relation between kinematic parameter and coordinate difference, the dynamic property of test and appraisal articulated robot 3, analyze articulated robot 3
Optimum occupation mode, thus path planning when moving for follow-up articulated robot 3 and speed controlling provide and instruct.
It should be noted that the articulated robot dynamic property evaluation system of the present invention is when actually used, can basis
The basic framework of system, increases the observation station of network interface camera 6, to adapt to specific detection demand.
From above technical scheme, the articulated robot dynamic property evaluation system of the present invention, including network interface camera
6th, optical target 7 and industrial computer 8;Using network interface camera 6 cooperation, industry control 8 mechanism builds camera calibration visual field, in multi-joint machine
People 3 end is rigidly connected optical target 7, by record articulated robot 3 under different motion parameter optical target 7 in camera
Field of detection repeats the changes in coordinates of mobile generation, is that the kinematic parameter of articulated robot 3 is moved through with articulated robot 3
In journey, the relation between produced coordinate difference provides intuitively data, with the dynamic property of articulated robot 3 of testing and assessing, and can
By the data of reperformance test, to analyze the occupation mode of articulated robot 3 optimum, thus being follow-up multi-joint machine
Path planning during people 3 motion and speed controlling provide and instruct.
Those skilled in the art, after considering description and putting into practice invention disclosed herein, will readily occur to its of the present invention
Its embodiment.The application is intended to any modification, purposes or the adaptations of the present invention, these modifications, purposes or
Person's adaptations are followed the general principle of the present invention and are included the undocumented common knowledge in the art of the present invention
Or conventional techniques.Description and embodiments are considered only as exemplary, and true scope and spirit of the invention are by following
Claim is pointed out.
It is described above and precision architecture illustrated in the accompanying drawings it should be appreciated that the invention is not limited in, and
And various modifications and changes can carried out without departing from the scope.The scope of the present invention only to be limited by appended claim.