Background technology
In motion control field, the moving components such as motor are the core component of realization motion control, such as the fortune of robot
Row just needs motor cooperation leading screw or retarder etc. as Motor execution component to drive robot motion.
By motor coordinate retarder for, motor cooperation retarder be articulated robot (or for multi-joint manipulator,
Multi-axis robot, mechanical arm etc.) main movement execution unit, articulated robot mainly according to scheduled route from one
Initial position grips target object to target location, is suitable for the mechanical automation operation of many industrial circles.
Articulated robot currently on the market includes mainly four axis robots (there are four joints for tool) and six-joint robot
(tool there are six joint) etc., they include pedestal, arm and the object of end clamping part, arm upper joint number certainly
The quantity of " axis " of Ding Liao robots, each joint are by the rotation of a motor to drive, to realize the movement in joint.
Currently, user needs to realize the ginseng to articulated robot by human-computer interaction device's (such as computer, teaching machine)
Number setting and control, human-computer interaction device currently on the market is whole both for robot greatly and designs, and user generally passes through
Motion control of the kinematic parameter realization in each joint to robot is edited, the kinematic parameter is actually controlled motion portion
The kinematic parameter of part (such as motor) after user edits the kinematic parameter of robot, is sent to the motion control portion of robot body
Part (or being driving controller etc.), controlled motion component moves after control parts of motion resolves the kinematic parameter received,
Chinese patent application if number of patent application is 201710438383.4 discloses a kind of articulated robot.
In conjunction with refer to the attached drawing 1, attached drawing 1 shows that a kind of articulated robot 100, robot 100 are a kind of four joint machines
Device people, robot 100 include pedestal 1, large arm 2, forearm 3, and wrist (being not shown in attached drawing 1), wrist can also be connected on forearm 3
On can have pawl (end effector), with realize be to the functions such as the crawl of object, such as number of patent application
201710381661.7 Chinese patent application discloses a kind of object clamping part, which can be mounted on as pawl
On wrist joint.
Moving component (motor and retarder) is respectively arranged on each joint of robot 100, such as in pedestal 1
A set of motor and retarder, the upper cover of the output shaft connect base 1 of retarder are provided in shell;The upper cover installation of pedestal 1 is big
The bottom of arm 2, large arm 2 is provided with another set of motor 4 and retarder 5, the ontology of the output axis connection large arm 2 of retarder 5;Big
The top of arm 2 is provided with another set of motor and retarder, the ontology of the output axis connection forearm 3 of retarder;In the front end of forearm 3
It is also provided with another set of motor and retarder, the ontology of the output axis connection wrist of retarder;Various ends can be installed on wrist
Actuator is held, such as number of patent application is object clamping part disclosed in 201710381661.7.
Motor rotary motion in pedestal 1 can drive the 360 degree rotation movement, in turn in the horizontal direction of the upper cover of pedestal 1
The 360 degree rotation in the horizontal direction such as large arm 2, forearm 3 with mobile robot 100;The rotary motion of motor 4 can drive large arm 2
It bows to move downward or swing back along the directions S2 along the directions S1 and move upwards, and then moved along the directions S1 or S2 with forearm 3 etc.;Greatly
The motor rotary motion on 2 top of arm can drive forearm 3 to be rotated, and then with rotary motions such as wrists;Forearm 3 it is another
The motor rotary motion of one end can drive wrist to be rotated, and then be rotated with end effector;End
Motor on actuator can also drive end effector to carry out the operations such as gripping object.
Above-mentioned multiple motors are controlled by different kinematic parameters to move by moving line set by user, so that it may to realize
To accurately controlling for robot 100, robot 100 is made to complete various functions set by user.
Control to each motor (such as motor 4) is realized by control parts of motion, and control parts of motion can be with
It is provided separately within the outside of robot 100, connect with each motor in robot 100 by connecting line;Control parts of motion
It can also be mounted in the body housing of robot 100.
For robot 100, the movement of each moving component can drive corresponding movable body to move, such as do in 1
Motor rotary motion the movable body of the compositions such as the upper cover of pedestal 1, large arm 2, forearm 3 can be driven to carry out 360 in the horizontal direction
Spend rotary motion;The rotary motion of 2 corresponding motor 4 of large arm the movable bodies of the compositions such as large arm 2, forearm 3 can be driven along S1 or
S2 (S1 is opposite with the direction of rotation of S2) is rotated;The rotary motion of motor (being not shown in attached drawing 1) at forearm 3 can
To drive the movable body that forearm 3 etc. forms along the rotary shaft rotary motion of forearm 3.
In conjunction with refer to the attached drawing 2, attached drawing 2 shows the circuit theory of kinetic control system 200 (such as robot), movement control
System 200 processed includes robot controller 201, gateway 202, control parts of motion 203, moving component 204, sensor 205
May include thering are multiple moving components 204 (such as to be provided with 4 or 5 electricity in robot 100 Deng, kinetic control system 200
Machine), a moving component 204 can also be comprised only;When kinetic control system 200 includes multiple moving components 204, often
A moving component 204 can be corresponding with respective control parts of motion 203 respectively, can also use the movement control of the same multiaxis
Component 203 processed controls and drives multiple moving components 204 simultaneously.
The robot controller 201 can be teaching machine, can also be the computer for being equipped with upper computer software, can be with
It is that mobile phone/Pad of APP etc. is installed, to realize human-computer interaction so that user can be configured by robot controller 201 and be transported
The functions such as dynamic parameter, the operating status of controlled motion component 204, display curve movement.
Gateway 202 is communicating machine people controller 201 and the component of control parts of motion 203, such as can be that USB turns
CAN gateways, RS232 turn CAN gateways etc., can user be converted to fortune by the kinematic parameter that robot controller 201 is arranged
The data of 203 readable format of dynamic control unit are simultaneously sent to control parts of motion 203, can also produce control parts of motion 203
Raw various feedback data are converted to the data of 201 readable format of robot controller and send to robot controller 201.
Control parts of motion 203 realizes the resolving of the kinematic parameter sent to robot controller 201, by user setting
Kinematic parameter generate control and drive motion components movement driving current, with drive motion components 204 move, and then drive
Corresponding movable body movement.
In kinetic control system 200, moving component 204 can be only motor, can also be motor combination retarder,
It can also be motor combination leading screw etc..Such as it is required on the joints such as pedestal 1, large arm 2, forearm 3, wrist in robot 100
One group of motor+retarder is set as respective moving component.
The movement position of movable body of the sensor 205 for detecting robot in real time, can be encoder, angle sensor
Device, optoelectronic switch, NI Vision Builder for Automated Inspection etc., by taking encoder as an example, the output end in moving component 204 can be arranged in encoder
In shaft, detection moving component 204 actual motion data.Encoder can be arranged directly on the defeated of motor and/or retarder
On shaft, when motor and/or retarder are connected with other shafts by transmission mechanism (such as belt etc.), encoder can also
It is arranged in other shafts, the actual motion data of sliding block, etc. that leading screw is detected on leading screw can also be arranged in encoder.
Sensor 205 follows movable body to move, and detects the actual motion data of movable body, the actual motion number that will be detected
According to the location information for being converted to movable body, the location information of each movable body in kinetic control system 100 can be obtained in real time.
Robot 100 in actual use, usually preset initial position of the zero-bit as robot 100, such as attached
After the pedestal 1 of Tu1Zhong robots 100 is fixed, zero-bit, which can be arranged, is:Large arm 2 is vertical with ground level, forearm 3 and large arm 2 are in 90
Degree vertical (i.e. forearm 3 is parallel with ground level), the initial zero position that the right side of large arm 2 and forearm 3 towards paper is robot 100,
Can also be separately provided the zero-bit in some joint, for example, can only using large arm 2 perpendicular to ground level as zero-bit, and forearm
3, forearm 3 and large arm 2 towards direction do not set zero-bit.
The purpose that zero-bit is arranged is easy for the moving line of user setting robot 100, such as in three-dimensional system of coordinate, uses
As soon as family needs robot 100 to complete from a point crawl object and the object is transported to another point, then needing root
Corresponding kinematic parameter is set according to the demand, can only pass through the space three-dimensional of the focus of the end effector of setting robot
Parameter controls the movement of robot, that is, the space coordinate for the target object being crawled is arranged and places the space coordinate of object,
Control parts of motion 203 can resolve the exercise data for each motor, cook up moving line;It can also be by the way that machine be arranged
The mode of the kinematic parameter in each joint of people 100 realizes action, such as it is that multiple transfers are made that can disassemble entire action, is first set
The parameters such as angle, the time of the rotation of bottom set seat 1, then the parameters such as the rotation angle of large arm 2, time are set, then 3 He of forearm is set
The parameters such as rotation angle/length of end effector, time, it is only necessary to notice that the sequential relationship between each transfer is made is all right,
It is sent to control parts of motion 203 after setting above-mentioned kinematic parameter, can also realize crawl of the robot 100 to target object
And placement.
Accuracy of the above method dependent on the initial zero position of robot 100, once the initial zero position of robot 100 is inaccurate
Really, then the exercise data of each motor of the robot 100 calculated just will appear deviation, the positioning of robot 100 is caused
It is accurate to reduce, the actions such as crawl object cannot be completed well.
There is certain movable space, therefore machine because of the tooth itself on the gear of motor, retarder etc. in robot 100
Inherently there is certain gap error into another motion process from a point in people 100, thus robot 100 from
Some position can have error when returning to initial zero position so that the zero-bit of robot 100 is inaccurate, and then influences robot
100 positioning accuracy.
Invention content
To solve the above-mentioned problems, it the present invention provides a kind of robot with accurate back to zero bit function, can reduce
Gap error in robot kinematics improves the accuracy that robot returns initial zero position.
Robot of the present invention with accurate back to zero bit function, includes control parts of motion, moving component, position
Detection sensor is set,
The control parts of motion, for driving the moving component to move according to kinematic parameter, with band mobile robot sheet
Movable body movement on body;
The position-detection sensor, the position for detecting the movable body in real time;
The first parameter preset and the second parameter preset are also pre-stored in the control parts of motion, and described first is default
Parameter and second parameter preset keep the direction of motion of the movable body opposite;
The control parts of motion receives a back to zero order of the bit, reads first parameter preset as the movement
Parameter;
A predeterminated position is reached when the position-detection sensor detects the movement position of the movable body, generates the
One trigger signal, the control parts of motion is sensitive to first trigger signal, reads second parameter preset as new
Kinematic parameter;
When the position-detection sensor detects that the movement position of the movable body arrives again at the predeterminated position, production
Raw second trigger signal, the control parts of motion is sensitive to second trigger signal, controls the movable body stop motion.
Illustrate as an example, in robot of the present invention, the control parts of motion receives a back to zero
Order of the bit after reading first parameter preset as the kinematic parameter, drives the moving component movement, with described in drive
Movable body moves with uniform velocity by first direction of motion.
As another for example, in robot of the present invention, the control parts of motion is touched to described first
After sensitive, reading second parameter preset signal as new kinematic parameter, the moving component movement is driven, to drive
The movable body moves with uniform velocity by second direction of motion opposite with first direction of motion, and second movement velocity
Less than first movement velocity.
As another for example, in robot of the present invention, the control parts of motion reads described second
Before parameter preset is as new kinematic parameter, also drive the moving component that the movable body is driven to do deceleration stop motion.
As another for example, in robot of the present invention, the control parts of motion is touched to described second
Signalling is sensitive, the control moving component stop motion is that the driving moving component drives the movable body emergency stop.
To solve the above-mentioned problems, the present invention also provides a kind of accurate back to zero position method, robot motion can be reduced
Gap error in the process improves the accuracy that robot returns initial zero position.
Accurate back to zero position method of the present invention is applied in above-mentioned robot, the method includes:
According to a back to zero order of the bit, the first parameter preset is read, makes the movable body of the robot along first side of moving
To movement;
When the movable body moves to a null positions, the first trigger signal of generation;
According to first trigger signal, the second parameter preset is read, the movable body of the robot is made to be moved along second
Direction moves, and second direction of motion is opposite with first direction of motion;
When the movable body is re-moved to the null positions, the second trigger signal of generation;
According to second trigger signal, make the movable body stop motion.
Illustrate as an example, in accurate back to zero position method of the present invention, the movable body of the robot is along
The movement of one direction of motion is moved with uniform velocity by the first movement velocity.
As another for example, in accurate back to zero position method of the present invention, the movable body edge of the robot
The movement of second direction of motion is to move with uniform velocity by the second movement velocity, and second movement velocity is less than described first and moves
Speed.
As another for example, in accurate back to zero position method of the present invention, according to first trigger signal,
Read the second parameter preset, make the movable body of the robot along second direction of motion move including:
According to first trigger signal, the movable body deceleration of the robot is made to stop;
Then the movable body is made to be moved along second direction of motion again.
As another for example, in accurate back to zero position method of the present invention, according to second trigger signal,
It is to make the movable body emergency stop to make the movable body stop motion.
To solve the above-mentioned problems, the present invention also provides a kind of kinetic control system with accurate back to zero bit function, institutes
It includes the above-mentioned robot with accurate back to zero bit function to state kinetic control system, can be reduced in robot kinematics
Gap error improves the accuracy that robot returns initial zero position.
To solve the above-mentioned problems, the present invention also provides a kind of computer-readable medium being stored with computer program,
The computer program is moved for one or more processors to execute accurate back to zero position method of the present invention, can be reduced
Gap error in robot kinematics improves the accuracy that robot returns initial zero position.
To solve the above-mentioned problems, the present invention provides a kind of robot with zero-bit function, robot can be reduced
Gap error in motion process improves the accuracy that robot returns initial zero position.
Robot of the present invention with zero-bit function includes control parts of motion, moving component, position detection
Sensor,
The control parts of motion, for being moved according to motion control commands drive motion components;
The moving component, for driving the movable body on robot body to move;
The position-detection sensor, the position for detecting the movable body under moving component drive in real time;
When the motion control commands are back to zero order of the bit:
The control parts of motion drives the moving component to drive the movable body by the according to the back to zero order of the bit
One direction of motion moves;
When the position-detection sensor detects that the movable body moves to a default zero-bit, generate the first triggering
Signal;
The control parts of motion is sensitive to first trigger signal, the driving moving component drives the movable body
It is moved by second direction of motion opposite with first direction of motion;
When the position-detection sensor detects that the movable body is re-moved to the default zero-bit, generate second
Trigger signal;
The control parts of motion is sensitive to second trigger signal, the driving moving component drives the movable body
Stop motion.
Illustrate as an example, in robot of the present invention, the control parts of motion is according to the back to zero position
Order drives the moving component to drive the movable body by the movement of first direction of motion, and the movable body is by the first movement
Speed moves with uniform velocity.
As another for example, in robot of the present invention, the control parts of motion is touched to described first
Signalling is sensitive, the driving moving component drives the movable body to be transported by second direction of motion opposite with first direction of motion
In dynamic, the movable body is to move with uniform velocity by the second movement velocity, and second movement velocity is less than described first and moves
Speed.
As another for example, in robot of the present invention, the control parts of motion is touched to described first
Signalling is sensitive, the driving moving component drives the movable body to be transported by second direction of motion opposite with first direction of motion
It is dynamic to include:The control parts of motion is sensitive to first trigger signal, the moving component is driven to drive the fortune first
Kinetoplast, which slows down, to be stopped, and then drives the moving component that the movable body is driven to be moved by second direction of motion again.
As another for example, in robot of the present invention, the control parts of motion is touched to described second
It is the driving moving component drive fortune that signalling is sensitive, the driving moving component drives the movable body stop motion
Kinetoplast emergency stop.
As another for example, in robot of the present invention, when the artificial articulated robot of the machine, institute
The joint that the movable body on robot body is articulated robot is stated, the joint turns in the drive lower edge of the moving component
Axis rotates;First direction of motion and second direction of motion are along two opposite direction of rotation of shaft.
As another for example, in robot of the present invention, when the artificial rectilinear machines people of the machine, institute
It is the sliding block moved along the linear guide to state the movable body on robot body, and the sliding block does straight line under the drive of moving component
It moves back and forth;First direction of motion and second direction of motion are along two opposite sides of moving of the linear guide
To.
In order to solve the above-mentioned technical problem, the present invention also provides a kind of back to zero position method of robot, the method includes
Have:
Preset a null positions;
According to a back to zero order of the bit, the movable body of robot is made to be moved along first direction of motion;
When the movable body moves to the null positions along first direction of motion, generate the first trigger signal;
According to first trigger signal, make the movable body along second the move side opposite with first direction of motion
To movement;
When the movable body is re-moved to the null positions along second direction of motion, generate the second triggering letter
Number;
According to second trigger signal, make the movable body stop motion.
Illustrate as an example, in the back to zero position method of robot of the present invention, the movable body of the robot
The specifically described movable body is moved along first direction of motion to move with uniform velocity by the first movement velocity.
As another for example, in the back to zero position method of robot of the present invention, the movement of the robot
Body moves the specifically described movable body along second direction of motion and moves with uniform velocity by the second movement velocity, and the second movement speed
Degree is less than the first movement velocity.
As another for example, in the back to zero position method of robot of the present invention, according to first triggering
Signal, make the movable body along second direction of motion opposite with first direction of motion move including:According to described first
Trigger signal makes the movable body deceleration stop;Then the movable body is made to be moved along second direction of motion again.
As another for example, in the back to zero position method of robot of the present invention, according to second triggering
Signal makes the movable body stop motion be specifically to make the movable body emergency stop.
To solve the above-mentioned problems, the present invention also provides a kind of kinetic control system with back to zero bit function, the fortune
Autocontrol system includes the above-mentioned robot with back to zero bit function, and the gap that can be reduced in robot kinematics is missed
Difference improves the accuracy that robot returns initial zero position.
To solve the above-mentioned problems, the present invention also provides a kind of computer-readable medium being stored with computer program, institutes
It states computer program to run to execute the back to zero position method of the robot for one or more processors, robot can be reduced
Gap error in motion process improves the accuracy that robot returns initial zero position.
To solve the above-mentioned problems, the present invention also provides another robot with back to zero bit function, the robots
Include one or more processors, be stored with the memory of computer program, when the computer program by one or
When multiple processors execute so that one or more of processors realize the back to zero position method of above-mentioned robot, can reduce
Gap error in robot kinematics improves the accuracy that robot returns initial zero position.
Robot provided by the invention drives the movable body of robot move in one direction, is straight first at back to zero position
Null positions are beaten to looking for for the first time, then controlled motion body stops, at this time since presence signal is delayed, the position that movable body is parked in
It is more to deviate from practical zero-bit, therefore is moved in the opposite direction in this drive motion body, it at this time can be with the fortune of controlled motion body
Dynamic speed, when finding zero-bit herein, controlled motion body emergency stop, the null positions that find at this time deviate the distance of practical zero-bit compared with
It is small, after the above process, movable body be parked on the position of a range zero relative close, reduce the back to zero of robot
Position error, improves the positional accuracy of robot.
Specific implementation mode
In order to make the foregoing objectives, features and advantages of the present invention clearer and more comprehensible, below in conjunction with the accompanying drawings and specific real
Applying mode, the present invention is described in further detail.
As a specific embodiment, in conjunction with refer to the attached drawing 1 and attached drawing 2, attached drawing 1 shows a kind of articulated robot
100 structure, attached drawing 2 show a kind of principle of kinetic control system 200, and kinetic control system 200 wraps in the present embodiment
Articulated robot 100 is included, kinetic control system 200 has specifically included robot controller 201, gateway 202, motion control
The moving components 204 such as component 203, moving component 204, position-detection sensor 205 are the motor in robot 100, robot
100 be a four articulated robot, and 4 joints and end effector may be used 5 motors and respectively drive, then motion control
The quantity of moving component 204 in system 200 is 5.
Robot controller 201 is connected to the control parts of motion 203 in robot 100 by gateway 202, collectively forms
Kinetic control system 200, user can by robot controller 201 arrange parameter, send order etc., to realize to machine
The control and driving of people 100.
The robot controller 201 can be teaching machine, can also be the computer for being equipped with upper computer software, can be with
It is that mobile phone/Pad of APP etc. is installed, to realize human-computer interaction so that user can be configured by robot controller 201 and be transported
The functions such as dynamic parameter, the operating status of controlled motion component 204 (motor), display curve movement.
Gateway 202 is communicating machine people controller 201 and the component of control parts of motion 203, such as can be that USB turns
CAN gateways, RS232 turn CAN gateways etc., can user be converted to fortune by the kinematic parameter that robot controller 201 is arranged
The data of 203 readable format of dynamic control unit are simultaneously sent to control parts of motion 203, can also produce control parts of motion 203
Raw various feedback data are converted to the data of 201 readable format of robot controller and send to robot controller 201.
Control parts of motion 203 realizes the resolving of the kinematic parameter sent to robot controller 201, by user setting
Kinematic parameter generate control and drive motion components movement driving current, with drive motion components 204 move, and then drive
Corresponding movable body movement.
Control parts of motion 203 can be single axial movement control unit, can also be Multi-axis motion control component.Single shaft fortune
Dynamic control unit only may be implemented to control a moving component, and each motor in robot 100 is required to connection one
Single axial movement control unit;Multi-axis motion control component, which can be realized simultaneously, controls multiple moving components, in robot 100
5 motors can only be controlled simultaneously with a Multi-axis motion control component;5 motors in robot 100 can also be by list
Axis control parts of motion and the control of Multi-axis motion control component combination.
In kinetic control system 200, moving component 204 can be only motor, can also be motor combination retarder
Deng.
The movement position of movable body of the position-detection sensor 205 for detecting robot in real time, can be encoder, angle
Sensor, optoelectronic switch, NI Vision Builder for Automated Inspection etc. are spent, by taking encoder as an example, encoder can be arranged in the defeated of moving component 204
In the shaft of outlet, detection moving component 204 actual motion data.Encoder can be arranged directly on motor and/or deceleration
On the output shaft of device, when motor and/or retarder are connected with other shafts by transmission mechanism (such as belt etc.), encoder
It can also be arranged in other shafts, the actual motion data for the sliding block that leading screw is detected on leading screw can also be arranged in encoder,
Etc..
Articulated robot 100 shown in attached drawing 1 includes pedestal 1, large arm 2, forearm 3, can also be connected on forearm 3
Wrist (is not shown) in attached drawing 1, can have pawl (end effector) on wrist, to realize to functions such as the crawls of object.
Moving component (motor and retarder) is respectively arranged on each joint of robot 100, such as in pedestal 1
A set of motor and retarder, the upper cover of the output shaft connect base 1 of retarder are provided in shell;The upper cover installation of pedestal 1 is big
The bottom of arm 2, large arm 2 is provided with another set of motor 4 and retarder 5, the ontology of the output axis connection large arm 2 of retarder 5;Big
The top of arm 2 is provided with another set of motor and retarder, the ontology of the output axis connection forearm 3 of retarder;In the front end of forearm 3
It is also provided with another set of motor and retarder, the ontology of the output axis connection wrist of retarder;Various ends can be installed on wrist
Actuator is held, such as number of patent application is object clamping part disclosed in 201710381661.7.
Motor rotary motion in pedestal 1 can drive the 360 degree rotation movement, in turn in the horizontal direction of the upper cover of pedestal 1
The 360 degree rotation in the horizontal direction such as large arm 2, forearm 3 with mobile robot 100;The rotary motion of motor 4 can drive large arm 2
It bows to move downward or swing back along the directions S2 along the directions S1 and move upwards, and then moved along the directions S1 or S2 with forearm 3 etc.;Greatly
The motor rotary motion on 2 top of arm can drive forearm 3 to be rotated, and then with rotary motions such as wrists;Forearm 3 it is another
The motor rotary motion of one end can drive wrist to be rotated, and then be rotated with end effector;End
Motor on actuator can also drive end effector to carry out the operations such as gripping object.
Above-mentioned multiple motors are controlled by different kinematic parameters to move by moving line set by user, so that it may to realize
To accurately controlling for robot 100, robot 100 is made to complete various functions set by user.
Control to each motor (such as motor 4) is realized by control parts of motion, and control parts of motion can be with
It is provided separately within the outside of robot 100, connect with each motor in robot 100 by connecting line;Control parts of motion
It can also be mounted in the body housing of robot 100.
For robot 100, the movement of each moving component can drive corresponding movable body to move, such as do in 1
Motor rotary motion the movable body of the compositions such as the upper cover of pedestal 1, large arm 2, forearm 3 can be driven to carry out 360 in the horizontal direction
Spend rotary motion;The rotary motion of 2 corresponding motor 4 of large arm the movable bodies of the compositions such as large arm 2, forearm 3 can be driven along S1 or
S2 (S1 is opposite with the direction of rotation of S2) is rotated;The rotary motion of motor (being not shown in attached drawing 1) at forearm 3 can
To drive the movable body that forearm 3 etc. forms along the rotary shaft rotary motion of forearm 3.
In robot 100, position-detection sensor can be by being mounted on retarder (such as retarder 5) output shaft
Rotary encoder is realized, can also be realized by the angular transducer on robot body, can be detected machine in real time
The location information in each joint of people 100.
When completing certain actions using robot 100 robot can be arranged by robot controller 201 in user
Every kinematic parameter, kinematic parameter may include having displacement (rotation angle etc.), time (or moment), speed etc., robot control
The kinematic parameter of user configuration is transferred to each control parts of motion 203, each motion control by device 201 processed by gateway 202
Component 203, which corresponds to, receives associ-ated motion parameters, and resolves the data for one group of control motor operation, is run with driving motor, into
And each joint with mobile robot 100 is moved according to the path that user needs.
When user using robot 100 before completing above-mentioned action, usually also needs to 100 back to zero position of robot, makes machine
Device people arrives first at a nominal zero, such as the large arm 2 of robot 100 is parallel to perpendicular to ground level, forearm 3 in attached drawing 1
Being oriented for arm that ground level (i.e. forearm 3 is vertical with large arm 2), large arm 2 and forearm 3 form (sees) towards paper can make to the right
For the initial zero position of robot 100, the pose of other robot can also be arranged as just in certain user according to the demand of itself
Beginning zero-bit.
Therefore, can a back to zero order of the bit be arranged by robot controller 201 first in user, then pass through gateway
The back to zero order of the bit is sent to control parts of motion 203 by 202, control parts of motion 203 receive back to zero order of the bit after, drive
The dynamic moving component 204 (motor and retarder i.e. in robot 100) drives respective movable body by some the first movement
Direction moves.Such as the motor in pedestal 1 can drive the movable body of the compositions such as the upper cover of pedestal 1, large arm 2, forearm 3 along up time
Needle is rotated counterclockwise;Motor in large arm 2 drives the movable body of the compositions such as large arm 2, forearm 3 with the rotation of large arm 2
Along the directions S1 or S2 azimuthal rotational motions centered on shaft (being the output shaft of the retarder 5 of large arm 3);Motor band in forearm 3
The movable body of the compositions such as dynamic forearm 3 is moved clockwise or counterclockwise centered on the rotary shaft of forearm 3.
It should be noted that user can only be arranged the zero-bit in some joint and only control the joint back to zero position, use
All movable joints (including end effector) of multiple joints or even robot 100 back to zero position simultaneously can also be arranged in family.
During control parts of motion 203 drives corresponding movable body to move along some direction, it is certain to return to one
Preset zero-bit, when position-detection sensor 205 detects that movable body moves to the preset zero-bit, generation one first is tactile
It signals, informs that the movable body of its driving of control parts of motion 203 reaches default zero-bit.
Control parts of motion 203 is sensitive to above-mentioned first trigger signal, the moving component 204 is driven to drive corresponding fortune
Kinetoplast by opposite with first direction of motion before second direction of motion movement, therefore movable body be certain to again pass by it is preset
Zero-bit.
Position-detection sensor 205 can detect that the movable body moves to zero-bit and generates one second and touch again
It signals, informs that the movable body of its driving of control parts of motion 203 has arrived again at default zero-bit.
Control parts of motion 203 is sensitive to the second trigger signal, drive motion components 204 drive movable body stop motion,
I.e. the movable body has reached zero-bit.
By above-mentioned processing, the zero-bit that robot 100 is eventually returned to is to have passed through revised zero-bit, that is, be have passed through positive and negative
The zero-bit moved back into twice reduces the error brought by the structure interval of robot 100 so that robot 100 returned to
Zero-bit is with preset zero-bit distance closer to the effect of back to zero position is more preferable, and the zero-bit returned to is more acurrate.
After the processing of above-mentioned back to zero position, user can send out the kinematic parameter being arranged by robot controller 100
Control parts of motion 203 is given, to drive robot 100 to carry out the actions such as actual crawl, completes the function that user wants.
Illustrate as an example, the control parts of motion 203 drive the moving component 204 along first side of moving
It really moves with uniform velocity to movement according to the first movement velocity, uniform motion can reduce what 100 acceleration and deceleration of robot were brought
More multiple error.
As a kind of deformation, the control parts of motion 203 is transported in the driving moving component 204 along first direction of motion
Dynamic can also be variable motion, can also achieve the purpose that move to zero-bit.
As another for example, the control parts of motion 203 it is sensitive to first trigger signal, driving described in
During moving component 204 drives the movable body to be moved by second direction of motion opposite with first direction of motion, the movable body
It is to move with uniform velocity by the second movement velocity, and second movement velocity is less than first movement velocity.
Uniform motion is easily controllable, and can reduce the more multiple error that acceleration and deceleration are brought to the greatest extent, and the second movement velocity is less than
First movement velocity makes back to zero position of the present invention more accurate, because the movement velocity of motor-driven movable body is smaller, moves to
Stop that required actual range is smaller, the error between zero-bit and preset zero-bit that movable body actually reaches is smaller, returns to
Zero-bit it is more accurate.
As a kind of deformation, the control parts of motion 203 is sensitive to first trigger signal, drives the movement portion
Part 204 drives the movable body by second direction of motion movement opposite with first direction of motion, and the movable body can also
Variable motion is done, can also achieve the purpose that back to zero position.
As another for example, the control parts of motion 203 it is sensitive to first trigger signal, driving described in
Moving component 204 drives the movable body to be moved by second direction of motion opposite with first direction of motion:
The control parts of motion 203 is sensitive to first trigger signal, the moving component 204 is driven to drive first
The movable body, which slows down, to be stopped, and then drives the moving component 204 that the movable body is driven to be moved by second direction of motion again.
The movable body move along first direction of motion be switched to moved along second direction of motion during, movable body
Firstly the need of stopping, then moving again.Using the method stopped of slowing down can reduce the inertia belt because of robot 100 come it is various
Problem, makes that the stopped process of robot 100 is gentle, is gradually decelerated to stopping, reducing the machine that the stopping of moving component 204 is brought
The harm that tool damages and reverse current is brought.
As a kind of deformation, the control parts of motion 203 is sensitive to first trigger signal, drives the movement portion
Part 204 drives the movable body to be moved by second direction of motion opposite with first direction of motion:
The control parts of motion 203 is sensitive to first trigger signal, the moving component 204 is driven to drive first
The movable body emergency stop, then drive the moving component 204 that the movable body is driven to be moved by second direction of motion.
In order to reduce the various problems that 100 emergency stop of robot is brought, the first movement speed of robot 100 can be arranged in user
Degree is small as possible, and smaller movement velocity can bring smaller damage.
As another for example, the control parts of motion 203 it is sensitive to second trigger signal, driving described in
It is that the moving component 204 is driven to drive the movable body emergency stop that moving component 204, which drives the movable body stop motion,.At this time
The movement velocity for the movable body that moving component 204 drives is smaller, and the various harm that emergency stop is brought are smaller, and emergency stop can make machine
The zero-bit that device people 100 finally stops is more acurrate.
As another deformation, the control parts of motion 203 is sensitive to second trigger signal, drives the movement
It is to drive the moving component 204 that the movable body is driven to do deceleration to stop that component 204, which drives the movable body stop motion, this
When damage smaller that robot 100 is brought.
As a kind of specific embodiment, in order to enable 100 back to zero position of robot is more convenient, it can also be in control parts of motion
In 203 and it is stored with the first parameter preset and the second parameter preset, first parameter preset can be with drive motion body along first
The direction of motion moves, and the second parameter preset can be moved with drive motion body along second direction of motion.
Therefore, when control parts of motion 203 receives the back to zero order of the bit, it is default that described first can be directly read
Parameter makes the moving component 204 that corresponding movable body be driven to be moved along first direction of motion, when movable body move to it is preset
Zero-bit, position-detection sensor 205 generate the first trigger signal, and control parts of motion 203 is sensitive to the first trigger signal, controls
Moving component 204 stops;Then the second parameter preset is read again as new kinematic parameter, and the moving component 204 is made to drive
Movable body is moved along second direction of motion, when movable body is re-moved to preset zero-bit, position-detection sensor 205 generates the
Two trigger signals, 203 controlled motion body stop motion of control parts of motion, robot 100 return to zero-bit.
The robot 100 of the present invention passes through positive and negative back to zero position twice, the error of the zero-bit eventually arrived at and preset zero-bit
It is smaller, back to zero position it is accurate higher.
As another specific embodiment, the application has submitted number of patent application on May 24th, 2017 and is
The application for a patent for invention of 201710381661.7, entitled " object aid portion and robot ", in conjunction with refer to the attached drawing 3, originally
Application discloses a kind of object aid portion 101, and object aid portion 101 can combine with robot 100, object is accommodated
Portion 101 is mounted on the end of forearm 3, one complete robot of composition, crawl of the realization to object.Object aid portion 101 1
Aspect can be under the driving of an individual motor on forearm 3 some shaft rotate, can also its individually
Motor drive under capture object.
Object aid portion 101 includes motor 6, worm screw 7, two groups of transmission mechanisms, optocoupler catch 10, photoelectric detectors 11,
First group of transmission mechanism includes turbine 8.1, crank 8.2, connecting rod 8.3, end fixture block 8.4, etc. second group of transmission mechanism includes whirlpool
Wheel 9.1, crank 9.2, connecting rod 9.3, end fixture block 9.4 etc..
The wherein described motor 6 is mounted on the ontology in object aid portion, and the output shaft of the motor 6 is solid with the worm screw 7
Fixed setting so that the axial direction of the axial direction of the worm screw 7 and the output shaft of the motor 6 point-blank, 8.1 He of the turbine
Turbine 9.1 is symmetricly set on the both sides of the worm screw 7 and is equipped with worm screw 7, the turbine 8.1, turbine 9.1 and worm screw 7
Gear structure is constituted by being staggered for tooth.
In first group of transmission mechanism, the turbine 8.1 passes through first rotating shaft and ontology rotation connection, the whirlpool
Wheel 8.1 can be rotated centered on first rotating shaft under the drive of the worm screw 7;The turbine 8.1 also with the crank 8.2 one
End is fixedly connected, and such as various prior arts of screw, rivet may be used in fixed form, and the crank 8.2 is in the turbine 8.1
When rotation, under the drive of the turbine 8.1 equally to be rotated centered on the first rotating shaft;The other end of the crank 8.2
It is rotatablely connected by the second shaft and 8.4 first connecting portion of end fixture block, one end of the connecting rod 8.3 passes through third shaft
It is rotatablely connected by the 4th shaft and the second connecting portion of the end fixture block 8.4 with ontology rotation connection, the other end, and described
First rotating shaft, the second shaft, third shaft, the 4th shaft constitute a parallelogram in axial projection.
Similar with first group of transmission mechanism, in second group of transmission mechanism, the turbine 9.1 passes through first rotating shaft and institute
State ontology rotation connection, the turbine 9.1 can be rotated centered on first rotating shaft under the drive of the worm screw 7;The turbine
9.1 are also fixedly connected with one end of the crank 9.2, and such as various prior arts of screw, rivet, institute may be used in fixed form
State crank 9.2 when the turbine 9.1 rotates, under the drive of the turbine 9.1 equally by first rotating shaft centered on rotate;Institute
The other end for stating crank 9.2 is rotatablely connected by the second shaft and 9.4 first connecting portion of end fixture block, the connecting rod 9.3
One end the 4th shaft and the end fixture block 9.4 are passed through by third shaft and ontology rotation connection, the other end the
Two interconnecting pieces are rotatablely connected, and the first rotating shaft, the second shaft, third shaft 1, the 4th shaft are constituted in axial projection
One parallelogram.
In object aid portion, two groups of transmission mechanisms together constitute the movable body in object aid portion.
It is also equipped with a photoelectric detector 11 on the ontology in end effector (object aid portion 101), wherein one
It is fixedly installed optocoupler catch 10 corresponding with photoelectric detector 11, optocoupler catch 10 on a connecting rod (connecting rod 8.3 or connecting rod 9.3)
Cooperation constitutes optoelectronic switch jointly with photoelectric detector 11, whether can move to initial zero position with detection object aid portion 101,
Optocoupler catch 10 and photoelectric detector 11 constitute the position-detection sensor in object aid portion 101.
When user needs object aid portion to move to initial zero position, can back to zero be set by robot controller 201
Order of the bit, control parts of motion 203 can be rotated with driving motor 6, and the rotation of motor 6 drives worm screw 7 to rotate, the rotation of worm screw 7
It drives turbine 8.1 and turbine 9.1 to rotate and then end fixture block 8.4 and 9.4 is driven inwardly to tighten or extend to the outside, can be arranged
Inwardly tightening movement or extend to the outside movement one of for first direction of motion, another be second direction of motion;Therefore when movement
When control unit 203 receives the order for making end effector back to zero position, can first driving motor 6 rotated to a direction,
And then drive the tightening of end fixture block 8.4 and 9.4 (or extension), in the process when optocoupler catch 10 reach photoelectric detector 11,
The first trigger signal is generated, control parts of motion 203 is sensitive to the first trigger signal, control motor 6 stops operating, object aid
Portion 101 stop, then again driving motor 6 rotate in the opposite direction so that drive end fixture block 8.4 and 9.4 extend to the outside (or
Inwardly tightening), when driving optocoupler catch 10 to be re-moved to photoelectric detector 11, generating the second trigger signal again, movement is controlled
Component 203 processed is sensitive to the second trigger signal, control motor 6 stops operating, and object aid portion 101 stops, and object accommodates at this time
Portion 101 stops arriving zero-bit.
As another specific embodiment, kinetic control system 200 can also use rectilinear machines people to realize, this opportunity
Device people includes motor, leading screw, the linear guide, the sliding block moved along the linear guide under leading screw driving, can be pacified on sliding block
Dress optocoupler catch installs photoelectric detector on robot body, and optocoupler catch and photoelectric detector constitute position detection sensing
Device, sliding block is the movable body of robot at this time, can be installed on sliding block other components, motor driving under it is past along the linear guide
Multiple movement.
Likewise, then user can also again be set when using rectilinear machines people first by slide block movement to null positions
Set the specific athletic performance of sliding block.
As another specific embodiment, in conjunction with attached drawing 4, the present invention also provides a kind of back to zero position methods of robot
S400, robot can be articulated robots 100, can be rectilinear machines people, can also be only end effector etc.
Deng the present embodiment is illustrated by taking articulated robot 100 as an example, and the method S400 includes:
Step S401:Preset a null positions;
Before completing certain actions using robot, it usually needs by robot back to zero position, robot is made to arrive first at one
Then a nominal zero drives 100 large arm 2 of robot in robot motion, such as attached drawing 1 perpendicular to ground level, forearm 3 again
Being oriented for arm that ground level (i.e. forearm 3 is vertical with large arm 2), large arm 2 and forearm 3 form is parallel to (to see towards paper) to the right
Can the pose of other robot can also be set according to the demand of itself as the initial zero position of robot 100, certain user
As initial zero position.
It should be noted that user can only be arranged the zero-bit in some joint and only control the joint back to zero position, use
All movable joints (including end effector) of multiple joints or even robot 100 back to zero position simultaneously can also be arranged in family.
Step S402:According to a back to zero order of the bit, the movable body of robot is made to be moved along first direction of motion;
After initial zero position is arranged, a back to zero order of the bit can be arranged in user, and it is dynamic to start back to zero position according to back to zero order of the bit
Make.
This step makes the movable body of robot be moved along first direction of motion first, such as the motor in pedestal 1 can band
The movable body edge of the compositions such as upper cover, large arm 2, the forearm 3 of dynamic pedestal 1 is rotated clockwise or counterclockwise;In large arm 2
Motor drives the movable body of large arm 2, the compositions such as forearm 3 to be with the rotary shaft (being the output shaft of the retarder 5 of large arm 3) of large arm 2
Center is along the directions S1 or S2 azimuthal rotational motions;Motor in forearm 3 drives the movable body of the compositions such as forearm 3 with the rotation of forearm 3
It is moved clockwise or counterclockwise centered on shaft.
Step S403:When the movable body moves to the null positions along first direction of motion, generate first
Trigger signal;
Movable body is certain to return to preset null positions along during first direction of motion moves, when detecting fortune
Kinetoplast generates first trigger signal when moving to the preset zero-bit.
Step S404:According to first trigger signal, make the movable body along opposite with first direction of motion
Second direction of motion moves, therefore movable body is certain to again pass by preset zero-bit.
Step S405:When the movable body is re-moved to the null positions along second direction of motion, generate
Second trigger signal;When movable body is along the second direction of motion motion process, it can detect that the movable body moves to again
Zero-bit simultaneously generates second trigger signal, informs that movable body has arrived again at default zero-bit.
Step S406:According to second trigger signal, the movable body stop motion, the i.e. movable body is made to have reached zero
Position.
By above-mentioned steps, the zero-bit that robot is eventually returned to is to have passed through revised zero-bit, that is, have passed through positive and negative two
The secondary zero-bit moved back into, reduces the error brought by the structure interval of robot so that zero-bit that robot returns to it is pre-
If zero-bit distance closer to the effect of back to zero position is more preferable, and the zero-bit returned to is more acurrate.
As another specific embodiment, in conjunction with refer to the attached drawing 5, the present invention also provides a kind of accurate back to zero position methods
S500 is applied in robot, and the present embodiment is illustrated by taking articulated robot 100 as an example, accurate back to zero position method S500
Including:
Step S501:According to a back to zero order of the bit, the first parameter preset is read, makes the movable body of the robot 100
It is moved along first direction of motion;
Before completing certain actions using robot, it usually needs by robot back to zero position, robot is made to arrive first at one
Then a nominal zero drives 100 large arm 2 of robot in robot motion, such as attached drawing 1 perpendicular to ground level, forearm 3 again
Being oriented for arm that ground level (i.e. forearm 3 is vertical with large arm 2), large arm 2 and forearm 3 form is parallel to (to see towards paper) to the right
Can the pose of other robot can also be set according to the demand of itself as the initial zero position of robot 100, certain user
As initial zero position.
It should be noted that user can only be arranged the zero-bit in some joint and only control the joint back to zero position, use
All movable joints (including end effector) of multiple joints or even robot 100 back to zero position simultaneously can also be arranged in family.
After initial zero position is arranged, a back to zero order of the bit can be arranged in user, and it is dynamic to start back to zero position according to back to zero order of the bit
Make.
This step makes the movable body of robot be moved along first direction of motion first, such as the motor in pedestal 1 can band
The movable body edge of the compositions such as upper cover, large arm 2, the forearm 3 of dynamic pedestal 1 is rotated clockwise or counterclockwise;In large arm 2
Motor drives the movable body of large arm 2, the compositions such as forearm 3 to be with the rotary shaft (being the output shaft of the retarder 5 of large arm 3) of large arm 2
Center is along the directions S1 or S2 azimuthal rotational motions;Motor in forearm 3 drives the movable body of the compositions such as forearm 3 with the rotation of forearm 3
It is moved clockwise or counterclockwise centered on shaft.
Step S502:When the movable body moves to a null positions, the first trigger signal of generation;
When movable body moves to default null positions, position-detection sensor 205 detects that the situation, generation first are touched
It signals.
Step S503:According to first trigger signal, the second parameter preset is read, makes the movable body edge of the robot
Second direction of motion moves, and second direction of motion is with first direction of motion on the contrary, therefore movable body is certain to again
By preset zero-bit.
Control parts of motion 203 is sensitive to first trigger signal in this step, controlled motion component 204 stops first
Movement, then reads the second parameter preset again, and the movable body of robot 100 is made to carry out counter motion along second direction of motion.
Step S504:When the movable body is re-moved to the null positions, position-detection sensor 205 can detect
Movable body arrives again at null positions, and generates the second trigger signal, informs that 203 movable body of control parts of motion arrives again at
Default zero-bit.
Step S505:Make the movable body stop motion according to second trigger signal, control parts of motion 203, i.e.,
The movable body has reached zero-bit.
By above-mentioned steps, the zero-bit that robot is eventually returned to is to have passed through revised zero-bit, that is, have passed through positive and negative two
The secondary zero-bit moved back into, reduces the error brought by the structure interval of robot so that zero-bit that robot returns to it is pre-
If zero-bit distance closer to the effect of back to zero position is more preferable, and the zero-bit returned to is more acurrate.
Property embodiment as an example, the present invention also provides a kind of computer-readable Jie being stored with computer program
Matter, the computer program are run for one or more processors, can execute the back to zero position side of robot of the present invention
Method S400.
As another exemplary embodiment, the present invention also provides a kind of robot with back to zero bit function, the machines
Device people includes one or more processors, is stored with the memory of computer program, when the computer program is by described one
When a or multiple processors execute so that one or more of processors realize the back to zero position method S400 of the robot.
As another exemplary embodiment, the present invention also provides another to be stored with the computer-readable of computer program
Medium, the computer program is run for one or more processors, to execute accurate back to zero position method of the present invention
S500。
Robot provided by the invention and back to zero position method are by driving the corresponding movable body of robot to be returned twice
Zero-bit makes movable body be moved near zero-bit and zero dead stop to a direction, then makes movable body counter motion again first
To zero-bit, then movable body is made to stop at zero-bit, the influence of the gap error of robot can be reduced, robot is made to be eventually returned to
Null positions and preset theoretical null positions closer to, the accuracy higher of back to zero position, the positioning for improving robot is accurate
Exactness.
Above-described is only specific embodiments of the present invention, it should be understood that the explanation of above example is only used
In facilitating the understanding of the method and its core concept of the invention, it is not intended to limit the scope of protection of the present invention, it is all the present invention's
Any modification for being made within thought and principle, equivalent replacement etc., should all be included in the protection scope of the present invention.