CN1010887B - Method for determining the position of a robot - Google Patents
Method for determining the position of a robotInfo
- Publication number
- CN1010887B CN1010887B CN88102951A CN88102951A CN1010887B CN 1010887 B CN1010887 B CN 1010887B CN 88102951 A CN88102951 A CN 88102951A CN 88102951 A CN88102951 A CN 88102951A CN 1010887 B CN1010887 B CN 1010887B
- Authority
- CN
- China
- Prior art keywords
- robot
- pulse
- standard shaft
- location
- shaft
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired
Links
- 238000000034 method Methods 0.000 title claims abstract description 15
- 230000033001 locomotion Effects 0.000 claims abstract description 14
- 238000001514 detection method Methods 0.000 claims description 25
- JEIPFZHSYJVQDO-UHFFFAOYSA-N ferric oxide Chemical compound O=[Fe]O[Fe]=O JEIPFZHSYJVQDO-UHFFFAOYSA-N 0.000 claims description 5
- 238000010586 diagram Methods 0.000 description 4
- 230000004888 barrier function Effects 0.000 description 2
- 230000003044 adaptive effect Effects 0.000 description 1
- 238000004904 shortening Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
- Control Of Position Or Direction (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
- Control And Safety Of Cranes (AREA)
Abstract
The method comprises two interlocked position incremental sensors which are arranged on a robot base shaft and rotate according to the movement distance of the robot base shaft and generate different numbers of pulse signals. The position of the robot can be determined by determining the difference in the number of pulses they generate. The position of the robot base shaft can be obtained by calculating the number difference of the reference pulses generated by the two position increment sensors at any position of the robot base shaft and calculating the pulse number from the reference position to the next reference pulse. The moving distance required for detecting the reference point can be shortened to be less than two turns of the position increment sensor, and the time required for detecting the position of the reference point is greatly shortened.
Description
The present invention relates to measure a kind of method of robot location, this method is applicable to robot, mechanical hand, machine-tool, handling machinery and similar applications.
Fig. 4 is the example of the robot location testing agency of routine.Wherein 1 is the standard shaft of robot, the 2nd, and the positional increment sensor, it is installed on the standard shaft, and the 3rd, the reference point detecting device is contained on the reference point location, and the 4th, position calculator, the 5th, controller, (comprising central processor CPU).Controller sends instruction for topworks's (not shown), the drives crankshaft motion.The positional increment sensor produces pulse signal according to the situation of standard shaft motion, is counted by location counter.When standard shaft process reference point location, the reference point detecting device just produces a detection signal and delivers to controller, and the latter then makes the counting of location counter recover initial value.
Make the machine man-hour rigidly connecting energize, can not know the position of robot standard shaft 1 in the robot location testing agency of above-mentioned routine.So, after the energized, robot standard shaft 1 at first will be to reference point detecting device 3 positions motions, and when detecting device 3 detects this robot standard shaft 1, this detecting device 3 just produces a detection signal and delivers to controller 5, and controller 5 receives that this detection signal just makes location counter rejuvenate value.In case location counter rejuvenate value just increases or reduces counting by location counter 4 at initialization values.The pulse signal that position transducer 2 produces is counted, with the position of detection machine people standard shaft 1.
More than, a kind of robot standard shaft 1 of the robot of routine is illustrated, and all robot standard shafts 1 all can be made similar operations.
Yet in the robot location testing agency of delta pulse generator as the routine of position transducer, in case cut off the ROBOT CONTROL power supply, the positional information of robot standard shaft 1 has just disappeared, thereby restive this robot.Consequently, when connecting the ROBOT CONTROL power supply, all must move to robot standard shaft 1 its reference point detecting device 3 places and make location counter 4 rejuvenate values.Thereby just have such practical problems: each detection reference need be changed the time of a few minutes; Secondly, because no matter the stop position of robot standard shaft 1 where, the detecting operation of reference point all makes robot standard shaft 1 turn back to reference point detecting device 3 once automatically, if between robot standard shaft 1 and the reference point detecting device 3 barrier is arranged, then robot standard shaft 1 will bump against on this barrier.
In order to address the above problem, application number is that 218942/1982 Jap.P. has disclosed two incremental encoders, they are locked mutually by a gear mechanism, the number of teeth of each gear all has difference each other slightly, and in the working range of robot standard shaft hunting gear, this each scrambler all is adaptive to for once produces zero-signal simultaneously.The position that these two scramblers are produced zero-signal simultaneously calls the initial point of this machine.Like this, as long as detect this position, just can determine the initial point of machine.Yet, even this method also is inadequate as the initial point detection means.
The objective of the invention is and to solve the above problems, even and if provide a kind of robot location's detection method that also can save the delta pulse generator significantly reference position detection time and robot work setup time as position transducer.
Even if another object of the present invention provides robot location's detection method of the security of a kind of move distance that also can reduce the delta pulse generator significantly the required robot standard shaft in detection machine people position as position transducer when having improved detection reference.
To achieve these goals, a kind of robot location's detection method has been proposed here, be characterized in, the positional increment sensor on the robot standard shaft of being installed in of two interlockings has been proposed, distance according to robot standard shaft motion, their rotations produce the different pulse signal of number, and on arbitrary movement position of robot standard shaft, calculating is from the poor (P of the pulse number of the reference pulse of these two positional increment sensors generations
2I), according to i=(P
1-P
2I)/(P
1-P
2) calculate from the pulse number (i) of next reference pulse of a certain reference position, and calculate P
1* i just can detect the position of robot benchmark.In the formula, P
1And P
2It is respectively the pulse number that described position transducer produced between one refunding.
In above-mentioned robot location's detection method, these two increment sensors that dispose with robot motion's standard shaft interlocked relationship produce different numbers according to the move distance of robot standard shaft pulse.On arbitrary position of the robot standard shaft that moves in the short distance, detect reference pulse, so as according to two kinds with reference to the pulse number between the pulse, calculate the position of robot benchmark immediately.So the revolution that the required move distance of detection reference can shorten to the positional increment sensor significantly is less than two circles, thus the required time of detection reference also can shorten significantly.
As mentioned above, according to the present invention, the setup time of robot work can shorten, and simultaneously the required robot standard shaft move distance of position probing also can shorten, thus the security when having improved detection reference.
Fig. 1 is for an embodiment block scheme of robot location's detection method of the present invention is described;
Fig. 2 is the sequential chart of key diagram 1 embodiment work.
Fig. 3 is the process flow diagram of key diagram 1 embodiment work.
Fig. 4 is the block scheme of the robot location testing agency of routine.
Now consult these description of drawings embodiments of the invention.
Shown in Figure 1 is the arrangement plan of robot location testing agency.Wherein, the 13rd, the driving shaft of positional increment sensor, the motion of its random device people standard shaft (not shown) and rotating.A gear that is installed on this driving shaft 13 is meshed with first reduction gearing 16, and subtracts gear 16 by first and be meshed with second reduction gearing 17, and the number of teeth of these two reduction gearing is different.Primary importance increment sensor (PLG1) 11 is installed in the rotating shaft of first reduction gearing 16, and second place increment sensor (PLG2) 12 is installed in the rotating shaft of second reduction gearing 17.The rotating shaft of the first and second positional increment sensors is connected respectively in the rotating shaft of first and second reduction gearing.Adjust the first and second positional increment sensors 11 with 12 according to the move distance of robot standard shaft and produce the pulse signal of different numbers according to first and second reduction gearing 16 and 17 number of teeth difference phase self-adaptations.The 14th, location counter.When rotating a predetermined angular, will the pulse A that location counter 14 produces be counted by sensor 11 (if moving 10 degree of sensor 11 revolutions produce a pulse, then 36 pulses of sensor 11 revolutions generation are exactly an example).The 15th, contain the controller of CPU, provide reference pulse Z by the first and second positional increment sensors 11 and 12 to it respectively
1And Z
2, and provide the number of the pulse A that is counted to it by location counter 14.When controller 15 detects from the reference pulse Z of the first and second positional increment sensors 11 and 12
1And Z
2And during from the umber of pulse A of the first and second positional increment sensors 11 and 12, controller 15 just makes location counter 14 initialization, and simultaneously, controller 15 is according to reference pulse Z
1And Z
2And the calculating be scheduled to of umber of pulse A, to measure the movement position of robot standard shaft.In the case, should produce the reference pulse Z of the first and second positional increment sensors 11 and 12 in advance according to the reference position of robot standard shaft
1And Z
2
The work of above-mentioned this robot location testing agency will illustrate in conjunction with the sequential chart of Fig. 2 and the process flow diagram of Fig. 3.After the energized, the robot standard shaft moves to arbitrary position, 13 of driving shafts rotate along with this motion, when driving shaft 13 rotates, primary importance increment sensor 11 rotates by first reduction gearing 16, second place increment sensor 12 rotates by second reduction gearing 17, so the first and second positional increment sensors 11 and 12 produce the reference pulse Z of sequential as shown in Figure 2
1And Z
2At reference pulse Z
1And Z
2When delivering to controller 15, location counter 14 has been counted the pulse A that produced by primary importance increment sensor 11 and A has been read in controller 15, and controller 15 is finished following operation to measure the position of robot standard shaft.
In robot standard shaft setting in motion, controller begins to detect by flow process I → II of Fig. 3 the reference pulse Z of primary importance increment sensor 11
1Suppose that primary importance increment sensor 11 is detecting reference pulse Z for the first time
1The time revolution from the reference position be i-1, and the pulse Z that detects is changeed in supposition at (i-1) shown in Figure 2
1Afterwards to the first reference pulse Z
2Location counter 14 count value of being read by flow process III → IV of Fig. 3 is P before
2I, so from the reference position, reference pulse Z
1Revolution i can be by the flow process V of Fig. 3 according to i=△ Pi/ △ PO=(P
1-P
2I)/△ PO calculates.Therefore, detecting the second reference pulse Z
1The time, just can be calculated as follows out the position of robot standard shaft.
Standard shaft position=the P of robot
1* i
In the case, detected second reference pulse Z when controller 15
1The time, just the count value (P of location counter 14
1* i) be initialized as the robot location's value that calculates above.
After this, motion along with the robot standard shaft, location counter 14 is the pulse A counting to producing from first incremental position transducer 11 just, and with the initial value addition of this count value and counter 14 or subtract each other, and adds like this or the result that subtracted has just represented the position of robot.
As mentioned above, in the present embodiment, the first and second positional increment sensors 11 and 12 are installed in respectively on the axle of first and second reduction gearing 16 and 17, first and second reduction gearing are meshed with driving shaft 13 successively by the gear of the number of teeth that differs from one another again, and driving shaft is then driven by the motion of robot standard shaft.Whenever revolving, first and second incremental position transducers 11 and 12 turn around, be sent to controller 15 by the reference pulse that they produced, when primary importance increment sensor 11 rotates predetermined angular, the pulse A that is produced by primary importance increment sensor 11 is counted by location counter 14, and its count value is delivered to controller 15.Thereby controller 15 calculates the poor (P of pulse number of the reference pulse of when the robot arbitrary position of the standard shaft first and second positional increment sensors 11 and 12
2I), again according to formula i=(P
1-P
2I)/(P
1-P
2) calculate from its reference position to the umber of pulse i of next reference pulse, like this, by P
1* i just can obtain the position of robot standard shaft.
Like this, this employing positional increment sensor method of measuring robot standard shaft position can make the required move distance in detection reference position be reduced to two commentaries on classics less than position transducer significantly.Therefore, the required time of detection reference also reduces significantly, has also reduced the setup time of robot work.Because of the remarkable shortening of the required move distance in detection machine people standard shaft position, the security when making detection reference also is improved again.
In the present embodiment, only a robot standard shaft to robot is described, and certainly, similar means also is applicable to all robot standard shafts of robot.
As mentioned above, according to the present invention, a kind of like this detection machine people can be provided the method for position, it can shorten the setup time of robot work significantly, can shorten the required robot standard shaft move distance of position probing significantly, thereby the security when having improved detection reference is although adopt the delta pulse generator also can shorten the detection time of reference position significantly as position transducer.
Claims (1)
1, the method for a kind of detection machine people position, it is characterized in that following step: it has two positional increment sensors that are installed on the robot standard shaft interlocked with one another, and can produce according to the move distance of robot standard shaft by its rotation and to have the different pulse signal of number, the poor (P of number of calculating robot's standard shaft reference pulse that these two positional increment sensors produce when movement position arbitrarily
2I) and by i=(P
1-P
2I)/(P
1-P
2) calculate from the reference position to the umber of pulse (i) next reference pulse, P
1And P
2Be respectively the umber of pulse that described position transducer whenever circles and produced, calculate P again
1* i just can obtain the position of robot standard shaft.
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP62121079A JPS63286705A (en) | 1987-05-20 | 1987-05-20 | Position detecting method for robot |
| JP121079/87 | 1987-05-20 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN88102951A CN88102951A (en) | 1988-11-30 |
| CN1010887B true CN1010887B (en) | 1990-12-19 |
Family
ID=14802334
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN88102951A Expired CN1010887B (en) | 1987-05-20 | 1988-05-19 | Method for determining the position of a robot |
Country Status (6)
| Country | Link |
|---|---|
| JP (1) | JPS63286705A (en) |
| KR (1) | KR940000366B1 (en) |
| CN (1) | CN1010887B (en) |
| AU (1) | AU611149B2 (en) |
| CA (1) | CA1323699C (en) |
| MY (1) | MY102208A (en) |
Families Citing this family (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN100351720C (en) * | 2002-05-05 | 2007-11-28 | 旋永南 | Operation and control system and mehod |
| JP5915417B2 (en) * | 2012-07-03 | 2016-05-11 | トヨタ車体株式会社 | Rotation position detector |
| CN108120370A (en) * | 2016-11-26 | 2018-06-05 | 沈阳新松机器人自动化股份有限公司 | Position of mobile robot acquisition methods and device |
| CN112374371B (en) * | 2020-11-20 | 2022-11-01 | 中船华南船舶机械有限公司 | Control method of crane rotation zero position switch |
| CN113364385B (en) * | 2021-06-09 | 2023-12-29 | 湖南东嘉智能科技有限公司 | Brushless motor initial position detection method without position sensor |
Family Cites Families (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS5911054A (en) * | 1982-07-12 | 1984-01-20 | Omron Tateisi Electronics Co | Data transmitter |
| JPS5988612A (en) * | 1982-11-15 | 1984-05-22 | Toshiba Mach Co Ltd | Method and apparatus for detecting absolute position |
| JPH0629723B2 (en) * | 1984-02-06 | 1994-04-20 | シンシナテイ・ミラクロン・インコーポレーテツド | Absolute position measuring method and device |
| JPS6191510A (en) * | 1984-10-12 | 1986-05-09 | Yaskawa Electric Mfg Co Ltd | Method and apparatus for detecting present position |
-
1987
- 1987-05-20 JP JP62121079A patent/JPS63286705A/en active Pending
-
1988
- 1988-05-11 MY MYPI88000497A patent/MY102208A/en unknown
- 1988-05-12 AU AU16083/88A patent/AU611149B2/en not_active Ceased
- 1988-05-12 CA CA000566558A patent/CA1323699C/en not_active Expired - Fee Related
- 1988-05-18 KR KR1019880005823A patent/KR940000366B1/en not_active IP Right Cessation
- 1988-05-19 CN CN88102951A patent/CN1010887B/en not_active Expired
Also Published As
| Publication number | Publication date |
|---|---|
| CA1323699C (en) | 1993-10-26 |
| MY102208A (en) | 1992-04-30 |
| AU611149B2 (en) | 1991-06-06 |
| KR940000366B1 (en) | 1994-01-19 |
| AU1608388A (en) | 1988-11-24 |
| CN88102951A (en) | 1988-11-30 |
| JPS63286705A (en) | 1988-11-24 |
| KR880013662A (en) | 1988-12-21 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US4488359A (en) | Automatic gear checking structure and method | |
| US4373301A (en) | Cam machining | |
| JPH07310582A (en) | Emergency control method for internal combustion engine | |
| US4253050A (en) | Method and apparatus for the synchronization of a gear machining apparatus | |
| US3267344A (en) | Numerically controlled work and feed motor driven gear-hobber | |
| GB2209696A (en) | Dressing a threaded grinding wheel in a gear grinding machine | |
| CN1010887B (en) | Method for determining the position of a robot | |
| US6501403B2 (en) | Calibrated encoder multiplier | |
| US4841297A (en) | Displacement coder | |
| JPS60262056A (en) | Electronic measuring method of rotary motion of reciprocating engine | |
| US5272648A (en) | Method of detecting a position of a robot | |
| US4902175A (en) | Method and apparatus for determining the angular position of a workpiece and positioning the same | |
| JP3097109B2 (en) | Spindle control method for machine tools | |
| JPS60239618A (en) | Detection of magnitude of rotation of rotating body by absolute value and apparatus thereof | |
| US5231340A (en) | Servomotor control method | |
| JPH04336915A (en) | Tooth alignment method for nc device | |
| JPH0678907B2 (en) | Absolute position detector | |
| CN117357744B (en) | Linear precision control device, control method and injection pump | |
| JP2819411B2 (en) | Fixed position stop control device | |
| JP3132740B2 (en) | Gear meshing method in gear processing equipment | |
| SU1767325A1 (en) | Method of rotation angle control | |
| JPH083733B2 (en) | Return to origin method of numerical controller | |
| Shoham | Feedback Devices | |
| KR20230088057A (en) | Escrow unit control device of automated teller machine | |
| SU1335931A1 (en) | Device for programmed control of floor polishing machine |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| C10 | Entry into substantive examination | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| C13 | Decision | ||
| GR02 | Examined patent application | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| C15 | Extension of patent right duration from 15 to 20 years for appl. with date before 31.12.1992 and still valid on 11.12.2001 (patent law change 1993) | ||
| OR01 | Other related matters | ||
| C19 | Lapse of patent right due to non-payment of the annual fee | ||
| CF01 | Termination of patent right due to non-payment of annual fee |