CN103791871A - Multi-joint mechanical arm calibration method - Google Patents
Multi-joint mechanical arm calibration method Download PDFInfo
- Publication number
- CN103791871A CN103791871A CN201410058088.2A CN201410058088A CN103791871A CN 103791871 A CN103791871 A CN 103791871A CN 201410058088 A CN201410058088 A CN 201410058088A CN 103791871 A CN103791871 A CN 103791871A
- Authority
- CN
- China
- Prior art keywords
- joint
- mechanical arm
- joint mechanical
- arm
- coordinate
- 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.)
- Pending
Links
Landscapes
- Transmission Devices (AREA)
Abstract
The invention discloses a multi-joint mechanical arm calibration method which comprises the following steps of (1) outfitting a mapping device; (2) collecting device data; (3) acquiring an elevation position; (4) acquiring a space coordinate: (4.1) obtaining a Z coordinate of an endpoint of a multi-joint horizontal swinging arm far away from the vertical axis; (4.2) calculating an X coordinate and a Y coordinate of the endpoint of the multi-joint horizontal swinging arm far away from the vertical axis; (4.3) controlling a multi-joint mechanical arm to perform space coordinate calibration on blades of a hydraulic turbine under test. The multi-joint mechanical arm calibration method has the advantages of (1) overcoming shortcomings of low manual calibration speed and poor precision in the prior art, adapting to control on molded line mapping quality of the blades of the hydraulic turbine on site widely, and being remarkable in effect; (2) being simple in operation, controlling errors of absolute calibration to be fewer than or equal to +/-1mm and error of repetition calibration to be fewer than or equal to +/-0.5mm, and performing instant calibration; (3) greatly increasing calibration speed and precision.
Description
Technical field
The invention belongs to hydro-electric power generating equipment technical field, be specifically related to a kind of multi-joint mechanical arm scaling method for the mapping of turbine blade molded line.
Background technology
Turbine runner blade is the curved surface of spatial warping, and after long-time running, wearing and tearing, seminess take place frequently, and need to overhaul repair welding processing.And in maintenance repair welding, require the strict vane type line of controlling to guarantee leaf quality, for this reason, must grasp feature and the spatial variations of vane type line comprehensively.Adopt widely multi-joint mechanical arm technology mapping turbine blade molded line, but according to the effect of on-the-spot mapping turbine blade molded line, use multi-joint mechanical arm tested turbine blade to be implemented to the demarcation of volume coordinate, often need to expend too much time and efforts, can not meet the requirement of on-the-spot duration.If blindly accelerated, make to demarcate and inaccurately more can bring error to the grasp of vane type line, directly affect quality control and the security of operation of blade maintenance.In view of this, urgently develop a kind of multi-joint mechanical arm that can use fast, accurately and efficiently in engineering construction tested turbine blade is implemented to the method that volume coordinate is demarcated, in the hope of can be with less input, strive for obtaining larger economic benefit.
Summary of the invention
The technical problem to be solved in the present invention is, for the defect of prior art, a kind of multi-joint mechanical arm scaling method is provided, uses the method can in engineering construction, use fast, accurately and efficiently multi-joint mechanical arm tested turbine blade to be implemented to the demarcation of volume coordinate.
Technical scheme of the present invention is that the multi-joint mechanical arm scaling method providing comprises the steps:
(1), be equipped with mapping equipment.Being equipped with one can be used for implementing the multi-joint mechanical arm that volume coordinate is demarcated to tested turbine blade.Described multi-joint mechanical arm generally by upright guide rail, the multi-joint horizontal pendulum swing arm that moves up and down along upright guide rail forms.From the product description of this multi-joint mechanical arm manufacturer dispensing, obtain performance parameter and the specifications parameter of this multi-joint mechanical arm.Measure the arm body length between each joint of multi-joint horizontal pendulum swing arm of this multi-joint mechanical arm; Measure the difference in height of every section of mechanical arm in elevation direction;
(2), collecting device data.The rotational angle of the each joint of the multi-joint mechanical arm code-disc that acquisition step (1) is equipped with;
(3), obtain elevation position.The motor shaft anglec of rotation that absolute type encoder on the vertical axes bottom servomotor of the multi-joint mechanical arm upright guide rail that acquisition step (1) is equipped with is measured, the multi-joint horizontal pendulum swing arm that calculates this multi-joint mechanical arm is done the elevation position up and down reciprocatingly moving freely on upright guide rail;
(4), obtain volume coordinate.The rotational angle of the difference in height with the arm body length between each joint of multi-joint horizontal pendulum swing arm of step (1) multi-joint mechanical arm of being surveyed and every section of mechanical arm in elevation direction, the each joint of the multi-joint mechanical arm code-disc that step (2) is gathered, and the elevation position that the multi-joint horizontal pendulum swing arm of the multi-joint mechanical arm that calculates of step (3) does up and down reciprocatingly to move freely on upright guide rail is foundation, use trigonometric function computing method to calculate as follows:
(4.1), utilize the absolute type encoder anglec of rotation on the vertical axes servomotor of described multi-joint mechanical arm, the each section of mechanical arm difference in height in elevation direction to calculate the height away from the multi-joint horizontal pendulum swing arm end points of vertical axes, obtain this Z coordinate away from the multi-joint horizontal pendulum swing arm end points of vertical axes;
(4.2), utilize the corner in each joint that the scrambler at the horizontal multistage shoulder joint place of the arm body length between each joint of described multi-joint mechanical arm, described multi-joint mechanical arm surveys, calculate X coordinate, Y coordinate away from the multi-joint horizontal pendulum swing arm end points of vertical axes;
(4.3) computing machine that, utilization is connected with the control system of described multi-joint mechanical arm, X volume coordinate, Y volume coordinate, the Z volume coordinate of the horizontal pendulum swing arm end points of the upright guide rail away from multi-joint mechanical arm calculating by step (4.1)～(4.2) are offered to the control system of multi-joint mechanical arm with serial port or network communication mode, to control multi-joint mechanical arm, tested turbine blade is implemented to volume coordinate demarcation.
The invention has the beneficial effects as follows:
1), made up the deficiency of multi-joint mechanical arm tradition demarcation mode, overcome that the speed of in the past manually demarcating is slow, the defect of low precision, thereby can be widely used in the on-the-spot control to turbine blade molded line mapping quality, effect is very remarkable;
2), have simple to operate, high, the fireballing feature of stated accuracy.Absolute calibration's error≤± 1mm, repeats calibrated error≤± 0.5mm., can realize thus instantaneous demarcation;
3), use high precision code-disc to measure joint rotation angle, introduce pulse and increase progressively technology, increased substantially demarcation speed and precision.
Embodiment:
Embodiment 1:
(1), be equipped with mapping equipment.Being equipped with one can be used for implementing the multi-joint mechanical arm that volume coordinate is demarcated to tested turbine blade.Institute joins multi-joint mechanical arm and adopts commercially available TBM-6 type multi-joint mechanical arm, and its vertical axes servomotor power is 200W, and upright guide rail effective travel is 1320mm, and multi-joint horizontal pendulum swing arm is five sections of mechanical arm interlinkage structures.From the product description of this multi-joint mechanical arm manufacturer dispensing, obtain performance parameter and the specifications parameter of this multi-joint mechanical arm.Measure the arm body length between each joint of multi-joint horizontal pendulum swing arm of this multi-joint mechanical arm; Measure the difference in height of every section of mechanical arm in elevation direction;
(2), collecting device data.The rotational angle of the each joint of the multi-joint mechanical arm code-disc that acquisition step (1) is equipped with;
(3), obtain elevation position.The motor shaft anglec of rotation that absolute type encoder on the vertical axes bottom servomotor of the multi-joint mechanical arm upright guide rail that acquisition step (1) is equipped with is measured, the multi-joint horizontal pendulum swing arm that calculates this multi-joint mechanical arm is done the elevation position up and down reciprocatingly moving freely on upright guide rail;
(4), obtain volume coordinate.The rotational angle of the difference in height with the arm body length between each joint of multi-joint horizontal pendulum swing arm of step (1) multi-joint mechanical arm of being surveyed and every section of mechanical arm in elevation direction, the each joint of the multi-joint mechanical arm code-disc that step (2) is gathered, and the elevation position that the multi-joint horizontal pendulum swing arm of the multi-joint mechanical arm that calculates of step (3) does up and down reciprocatingly to move freely on upright guide rail is foundation, use trigonometric function computing method to calculate as follows:
(4.1), utilize the absolute type encoder anglec of rotation on the vertical axes servomotor of described multi-joint mechanical arm, the each section of mechanical arm difference in height in elevation direction to calculate the height away from the multi-joint horizontal pendulum swing arm end points of vertical axes, obtain this Z coordinate away from the multi-joint horizontal pendulum swing arm end points of vertical axes;
(4.2), utilize the corner in each joint that the scrambler at the horizontal multistage shoulder joint place of the arm body length between each joint of described multi-joint mechanical arm, described multi-joint mechanical arm surveys, calculate X coordinate, Y coordinate away from the multi-joint horizontal pendulum swing arm end points of vertical axes;
(4.3) computing machine that, utilization is connected with the control system of described multi-joint mechanical arm, X volume coordinate, Y volume coordinate, the Z volume coordinate of the horizontal pendulum swing arm end points of the upright guide rail away from multi-joint mechanical arm calculating by step (4.1)～(4.2) are offered to the control system of multi-joint mechanical arm with serial port, to control multi-joint mechanical arm, tested turbine blade is implemented to volume coordinate demarcation.
Embodiment 2:
(1), be equipped with mapping equipment.Being equipped with one can be used for implementing the multi-joint mechanical arm that volume coordinate is demarcated to tested turbine blade.Institute joins multi-joint mechanical arm and adopts commercially available TBM-5 type multi-joint mechanical arm, and its vertical axes servomotor power is 200W, and upright guide rail effective travel is 1200mm, and multi-joint horizontal pendulum swing arm is four sections of mechanical arm interlinkage structures.From the product description of this multi-joint mechanical arm manufacturer dispensing, obtain performance parameter and the specifications parameter of this multi-joint mechanical arm.Measure the arm body length between each joint of multi-joint horizontal pendulum swing arm of this multi-joint mechanical arm; Measure the difference in height of every section of mechanical arm in elevation direction;
Step (2)～(3) are with embodiment 1;
(4), obtain volume coordinate.The rotational angle of the difference in height with the arm body length between each joint of multi-joint horizontal pendulum swing arm of step (1) multi-joint mechanical arm of being surveyed and every section of mechanical arm in elevation direction, the each joint of the multi-joint mechanical arm code-disc that step (2) is gathered, and the elevation position that the multi-joint horizontal pendulum swing arm of the multi-joint mechanical arm that calculates of step (3) does up and down reciprocatingly to move freely on upright guide rail is foundation, use trigonometric function computing method to calculate as follows:
Step (4.1)～(4.2) are with embodiment 1;
(4.3) computing machine that, utilization is connected with the control system of described multi-joint mechanical arm, X volume coordinate, Y volume coordinate, the Z volume coordinate of the horizontal pendulum swing arm end points of the upright guide rail away from multi-joint mechanical arm calculating by step (4.1)～(4.2) are offered to the control system of multi-joint mechanical arm with network communication mode, to control multi-joint mechanical arm, tested turbine blade is implemented to volume coordinate demarcation.
Claims (1)
1. a multi-joint mechanical arm scaling method, the method comprises the steps:
(1), be equipped with mapping equipment, being equipped with one can be used for implementing the multi-joint mechanical arm that volume coordinate is demarcated to tested turbine blade, from the product description of this multi-joint mechanical arm manufacturer dispensing, obtain performance parameter and the specifications parameter of this multi-joint mechanical arm, measure the arm body length between each joint of multi-joint horizontal pendulum swing arm of this multi-joint mechanical arm; Measure the difference in height of every section of mechanical arm in elevation direction;
(2), collecting device data, the rotational angle of the each joint of the multi-joint mechanical arm code-disc that acquisition step (1) is equipped with;
(3), obtain elevation position, the motor shaft anglec of rotation that absolute type encoder on the vertical axes bottom servomotor of the multi-joint mechanical arm upright guide rail that acquisition step (1) is equipped with is measured, the multi-joint horizontal pendulum swing arm that calculates this multi-joint mechanical arm is done the elevation position up and down reciprocatingly moving freely on upright guide rail;
(4), obtain volume coordinate, the rotational angle of the difference in height with the arm body length between each joint of multi-joint horizontal pendulum swing arm of step (1) multi-joint mechanical arm of being surveyed and every section of mechanical arm in elevation direction, the each joint of the multi-joint mechanical arm code-disc that step (2) is gathered, and the elevation position that the multi-joint horizontal pendulum swing arm of the multi-joint mechanical arm that calculates of step (3) does up and down reciprocatingly to move freely on upright guide rail is foundation, use trigonometric function computing method to calculate as follows:
(4.1), utilize the absolute type encoder anglec of rotation on the vertical axes servomotor of described multi-joint mechanical arm, the each section of mechanical arm difference in height in elevation direction to calculate the height away from the multi-joint horizontal pendulum swing arm end points of vertical axes, obtain this Z coordinate away from the multi-joint horizontal pendulum swing arm end points of vertical axes;
(4.2), utilize the corner in each joint that the scrambler at the horizontal multistage shoulder joint place of the arm body length between each joint of described multi-joint mechanical arm, described multi-joint mechanical arm surveys, calculate X coordinate, Y coordinate away from the multi-joint horizontal pendulum swing arm end points of vertical axes;
(4.3) computing machine that, utilization is connected with the control system of described multi-joint mechanical arm, X volume coordinate, Y volume coordinate, the Z volume coordinate of the horizontal pendulum swing arm end points of the upright guide rail away from multi-joint mechanical arm calculating by step (4.1)～(4.2) are offered to the control system of multi-joint mechanical arm with serial port or network communication mode, to control multi-joint mechanical arm, tested turbine blade is implemented to volume coordinate demarcation.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410058088.2A CN103791871A (en) | 2014-02-20 | 2014-02-20 | Multi-joint mechanical arm calibration method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410058088.2A CN103791871A (en) | 2014-02-20 | 2014-02-20 | Multi-joint mechanical arm calibration method |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN103791871A true CN103791871A (en) | 2014-05-14 |
Family
ID=50667759
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201410058088.2A Pending CN103791871A (en) | 2014-02-20 | 2014-02-20 | Multi-joint mechanical arm calibration method |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN103791871A (en) |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108436904A (en) * | 2018-01-24 | 2018-08-24 | 上海岭先机器人科技股份有限公司 | A kind of absolute angle measuring method of manipulator joint without encoder |
| CN108748154A (en) * | 2018-06-11 | 2018-11-06 | 浙江国自机器人技术有限公司 | A kind of system and method for calibration mechanical arm |
| CN109877840A (en) * | 2019-04-02 | 2019-06-14 | 哈尔滨工程大学 | A kind of double mechanical arms scaling method based on camera optical axis constraint |
| WO2020037989A1 (en) * | 2018-08-22 | 2020-02-27 | 中科新松有限公司 | Position information self-calibration method, storage medium, and computer device |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP1403630A2 (en) * | 2002-09-30 | 2004-03-31 | CENTRO SVILUPPO MATERIALI S.p.A. | Device for evaluating resistance to formation of mechanical damages in structural and esthetic elements and use thereof |
| CN101149256A (en) * | 2007-11-05 | 2008-03-26 | 中山大学 | Follow-up type measuring mechanical arm calibration method based on distance leash |
| CN101451832A (en) * | 2008-12-30 | 2009-06-10 | 三一重工股份有限公司 | Method and device for calibrating sensor for measuring angle of mechanical arm or manipulator |
| WO2014012304A1 (en) * | 2012-07-20 | 2014-01-23 | 重庆市电力公司电力科学研究院 | Electrical energy meter verification system and robot therefor |
-
2014
- 2014-02-20 CN CN201410058088.2A patent/CN103791871A/en active Pending
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP1403630A2 (en) * | 2002-09-30 | 2004-03-31 | CENTRO SVILUPPO MATERIALI S.p.A. | Device for evaluating resistance to formation of mechanical damages in structural and esthetic elements and use thereof |
| CN101149256A (en) * | 2007-11-05 | 2008-03-26 | 中山大学 | Follow-up type measuring mechanical arm calibration method based on distance leash |
| CN101451832A (en) * | 2008-12-30 | 2009-06-10 | 三一重工股份有限公司 | Method and device for calibrating sensor for measuring angle of mechanical arm or manipulator |
| WO2014012304A1 (en) * | 2012-07-20 | 2014-01-23 | 重庆市电力公司电力科学研究院 | Electrical energy meter verification system and robot therefor |
Non-Patent Citations (2)
| Title |
|---|
| 唐卫平: "TBM-6型水轮机转轮叶型测绘仪及其应用", 《大电机技术》 * |
| 唐卫平: "大型水轮发电机组水轮机转轮叶型测绘仪的研制", 《华中电力》 * |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108436904A (en) * | 2018-01-24 | 2018-08-24 | 上海岭先机器人科技股份有限公司 | A kind of absolute angle measuring method of manipulator joint without encoder |
| CN108748154A (en) * | 2018-06-11 | 2018-11-06 | 浙江国自机器人技术有限公司 | A kind of system and method for calibration mechanical arm |
| WO2020037989A1 (en) * | 2018-08-22 | 2020-02-27 | 中科新松有限公司 | Position information self-calibration method, storage medium, and computer device |
| CN109877840A (en) * | 2019-04-02 | 2019-06-14 | 哈尔滨工程大学 | A kind of double mechanical arms scaling method based on camera optical axis constraint |
| CN109877840B (en) * | 2019-04-02 | 2021-09-28 | 哈尔滨工程大学 | Double-mechanical-arm calibration method based on camera optical axis constraint |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN103791871A (en) | Multi-joint mechanical arm calibration method | |
| US20170198680A1 (en) | A wind turbine yaw control method and system | |
| CN102513355A (en) | Control method for flying shear tail-shearing of rod wire | |
| CN102864800A (en) | Horizontal pushing control method and control device for excavator and excavator | |
| CN106968875A (en) | Pump turbine gate positing measurement apparatus and method | |
| EP2371708A3 (en) | Controlling blade pitch angle | |
| CN105986960B (en) | A kind of wind speed evaluation method for wind power generator control system | |
| CN104359445A (en) | Serial movement mechanism parameter error measuring device and method based on pull rope encoder | |
| CN205036505U (en) | Automatic zero adjustment device of wind generating set blade | |
| CN207113782U (en) | A kind of rotor clearance measurement tool | |
| CN104089705B (en) | Rocker type multipoint crop canopy infrared temperature detection system and method | |
| CN203982204U (en) | Metal works rectilinear motion positioning control system based on eddy current sensor | |
| CN105547230A (en) | Airplane horizontal tail deflection angle measurement method on the basis of linear displacement method | |
| CN203365388U (en) | Spherical rotary adjusting device for ultrasonic probe | |
| CN202137578U (en) | Wind generating set blade hub zero line centering device | |
| CN202903164U (en) | Hook height measurement system used for petroleum drilling machine | |
| CN204945166U (en) | Aviation speed probe proving installation | |
| CN202956091U (en) | Icing monitoring device | |
| CN205957847U (en) | A metering device for assembly of turbine blade seat | |
| CN204183572U (en) | A kind of 3-dof parallel robot Zero calibration device | |
| CN205237496U (en) | Wind turbine generator system wind vane alignment device | |
| CN107524660A (en) | A kind of large-sized structural parts play the control method and control system of perpendicular straightening | |
| CN204115719U (en) | Tunnel cross-section measurement point laying out apparatus | |
| CN205037867U (en) | A three -dimensional dynamic measurement system for bucket -wheel stacker reclaimer | |
| CN103016237A (en) | Water turbine peddle adjustment and measurement method and peddle measurement device for method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| RJ01 | Rejection of invention patent application after publication |
Application publication date: 20140514 |
|
| RJ01 | Rejection of invention patent application after publication |