CN114237230A - Path planning method and system of temperature measurement sampling robot and readable storage medium - Google Patents

Path planning method and system of temperature measurement sampling robot and readable storage medium Download PDF

Info

Publication number
CN114237230A
CN114237230A CN202111433142.3A CN202111433142A CN114237230A CN 114237230 A CN114237230 A CN 114237230A CN 202111433142 A CN202111433142 A CN 202111433142A CN 114237230 A CN114237230 A CN 114237230A
Authority
CN
China
Prior art keywords
temperature measurement
sampling robot
robot
gun
path planning
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.)
Granted
Application number
CN202111433142.3A
Other languages
Chinese (zh)
Other versions
CN114237230B (en
Inventor
吴曼玲
谭云龙
龚贵波
刘景亚
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
CISDI Engineering Co Ltd
CISDI Research and Development Co Ltd
Original Assignee
CISDI Engineering Co Ltd
CISDI Research and Development Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by CISDI Engineering Co Ltd, CISDI Research and Development Co Ltd filed Critical CISDI Engineering Co Ltd
Priority to CN202111433142.3A priority Critical patent/CN114237230B/en
Publication of CN114237230A publication Critical patent/CN114237230A/en
Application granted granted Critical
Publication of CN114237230B publication Critical patent/CN114237230B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Multimedia (AREA)
  • Electromagnetism (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Investigating And Analyzing Materials By Characteristic Methods (AREA)

Abstract

The invention provides a path planning method and system of a temperature measurement sampling robot and a readable storage medium, and belongs to the technical field of measurement. The path planning method of the temperature measurement sampling robot comprises the following steps: the method comprises the steps of obtaining the liquid level height of molten steel in a ladle through a visual acquisition device, and planning a gun falling path of a temperature measurement sampling robot according to the liquid level height of the molten steel. The path planning system of the temperature measurement sampling robot is used for the path planning method of the temperature measurement sampling robot, and comprises the temperature measurement sampling robot, a vision acquisition device and a control module. The computer readable storage medium stores a computer program thereon, and the program is executed by a processor to realize the path planning method of the temperature measurement sampling robot. The invention can detect the liquid level height of the molten steel in the ladle, calculate the coordinates of the target point of the robot under the current liquid level height, and guide the robot to move so as to improve the success rate and the accuracy of the temperature measurement and sampling robot for measuring the temperature of the molten steel.

Description

Path planning method and system of temperature measurement sampling robot and readable storage medium
Technical Field
The invention relates to the technical field of detection, in particular to a path planning method and system of a temperature measurement sampling robot and a readable storage medium.
Background
In the field of ferrous metallurgy, the temperature measurement sampling robot is widely applied to a plurality of smelting links, and the robot is used for replacing manual work to perform temperature measurement sampling on molten metal. In the production process, the molten steel clearance height in different steel ladles is not constant, so that the robot is required to adapt to molten steel levels with different heights to carry out temperature measurement and sampling, and the success rate of temperature measurement and sampling is improved.
At present, the control mode of a robot temperature measurement sampling gun descending path mainly comprises the following modes: mode 1, a fixed trajectory, a fixed depth, and a robot repeat work are taught. In the mode 2, three liquid levels of high, middle and low are set according to experience summary, namely a plurality of paths are taught, and the robot motion path is manually selected according to the steel tapping amount to measure the temperature. Mode 3, the clearance height of the molten steel is measured by a sensor, for example, a laser sensor, the measured value is sent to a robot, and the robot adjusts the depth of the lower lance on line according to the depth of the liquid level of the molten steel.
The modes 1 and 2 both belong to a robot fixed path selection mode, and cannot be adjusted on line according to the actual molten steel liquid level height of each furnace, so that the success rate of temperature measurement is low. The laser sensor in the mode 3 has limitation in use, the steel ladle clearance height can be returned only when the laser is irradiated on the steel slag, and if the laser is directly irradiated on the steel liquid level, the height value cannot be obtained.
Disclosure of Invention
In view of the above-mentioned shortcomings in the prior art, an object of the present invention is to provide a method and a system for planning a path of a temperature measurement sampling robot, and a readable storage medium, which are used to solve the problems of low success rate of temperature measurement and limited use in the prior art.
In order to achieve the above and other related objects, the present invention provides a path planning method for a temperature measurement sampling robot, which provides a vision collecting device, comprising the steps of: the method comprises the steps of obtaining the liquid level height of molten steel in a ladle through a visual acquisition device, and planning a gun falling path of a temperature measurement sampling robot according to the liquid level height of the molten steel.
Optionally, the vision acquisition device is arranged at a working end of the temperature measurement sampling robot, and the temperature measurement sampling robot moves the vision acquisition device to enable the liquid level of the molten steel in the steel ladle to be within an acquisition range of the vision acquisition device.
Optionally, calibrating the vision acquisition device to obtain a transformation matrix of the coordinate system of the vision acquisition device relative to the base coordinate of the temperature measurement sampling robot.
Optionally, in the gun descending process, the posture of the temperature measurement sampling robot is kept unchanged, the gun descending direction of the temperature measurement sampling robot is obtained according to the field environment, a function of the gun descending direction relative to the height direction is established, and the temperature measurement point p is obtained according to the liquid level height of the molten steel in the ladle and the function of the gun descending directionTemperature measurementThe coordinates of (a).
Optionally, the lowest point of the temperature measurement sampling robot in the ladle gun is obtained according to a site environment or a process layout drawing, and the gun falling direction of the temperature measurement sampling robot is obtained according to the site environment and the lowest point.
Optionally, the starting insertion point p is preset1(x1,y1,z1,q1,q2,q3,q4) Presetting an end insertion point p2(x2,y2,z2,q1,q2,q3,q4) The start insertion point and the end insertion point are both in the down-gun direction,
wherein the coordinate system of the temperature measuring and sampling robot is (x, y, z), z is the direction of the liquid level height of the molten steel, and x is1,y1,z1Is p1Coordinate under coordinate system of temperature measuring and sampling robot, x2,y2,z2Is p2Coordinates in the coordinate System of the thermometric sampling robot, q1,q2,q3,q4Is a robot posture quaternion.
According to p1And p2Obtaining x ═ fx(z),y=fy(z) according to the height z of the liquid level of the molten steel in the ladle obtained by the vision acquisition deviceAt presentAnd x ═ fx(z),y=fy(z) obtaining a temperature measurement point pTemperature measurementCoordinate of (a), p1To pTemperature measurementThe connecting line between the two is the gun-discharging path of the temperature-measuring sampling robot.
The invention also provides a path planning system of the temperature measurement sampling robot, which is used for implementing the path planning method of the temperature measurement sampling robot, and the path planning system comprises the following steps: the temperature measurement sampling robot is provided with a measuring gun; the vision acquisition device is arranged on the measuring gun and can move along with the measuring gun; and the control module is connected with the temperature measurement sampling robot and the vision acquisition device.
The invention also provides a computer readable storage medium, on which a computer program is stored, which when executed by a processor, implements the method for path planning for a thermometric sampling robot as described in any one of the above.
As described above, the method, system and readable storage medium for planning the path of the temperature measurement sampling robot of the present invention have the following advantages: the visual acquisition device is used for detecting the liquid level height of the molten steel in the ladle, the height is transmitted to the robot, the current liquid level height is used for obtaining the target point coordinate of the robot, the robot is guided to move, and the success rate and the accuracy of the temperature measurement sampling robot for measuring the temperature of the molten steel are improved.
Drawings
Fig. 1 is a flow chart of a path planning method of a temperature measurement sampling robot according to an embodiment of the present invention.
Fig. 2 is a schematic diagram of a path planning system of a temperature measurement sampling robot according to an embodiment of the present invention.
Detailed Description
The embodiments of the present invention are described below with reference to specific embodiments, and other advantages and effects of the present invention will be easily understood by those skilled in the art from the disclosure of the present specification. The invention is capable of other and different embodiments and of being practiced or of being carried out in various ways, and its several details are capable of modification in various respects, all without departing from the spirit and scope of the present invention.
It should be noted that the drawings provided in the present embodiment are only for illustrating the basic idea of the present invention, and the components related to the present invention are only shown in the drawings rather than drawn according to the number, shape and size of the components in actual implementation, and the type, quantity and proportion of the components in actual implementation may be changed freely, and the layout of the components may be more complicated. The structures, proportions, sizes, and other dimensions shown in the drawings and described in the specification are for understanding and reading the present disclosure, and are not intended to limit the scope of the present disclosure, which is defined in the claims, and are not essential to the art, and any structural modifications, changes in proportions, or adjustments in size, which do not affect the efficacy and attainment of the same are intended to fall within the scope of the present disclosure. In addition, the terms "upper", "lower", "left", "right", "middle" and "one" used in the present specification are for clarity of description, and are not intended to limit the scope of the present invention, and the relative relationship between the terms and the terms is not to be construed as a scope of the present invention.
Referring to fig. 1, the present embodiment provides a method for planning a path of a temperature measurement sampling robot, including the following steps:
s1: and a vision acquisition device is carried on a tail end flange of the temperature measurement sampling robot, and then the robot is moved right above the steel ladle, so that the liquid level of the molten steel in the steel ladle is in the detection range of the vision acquisition device.
In some embodiments, the vision acquisition device needs to be calibrated first before it can be operated. And calibrating a conversion matrix between the coordinate system of the vision acquisition device and the tool coordinate system of the flange at the tail end of the temperature measurement sampling robot, and then obtaining the conversion matrix between the coordinate system of the vision acquisition device and the base coordinate of the temperature measurement sampling robot, so that the coordinates of a target point measured by the vision acquisition device can be converted to be under the base coordinate of the temperature measurement sampling robot.
S2: visual collection device is to ladleAnd measuring the liquid level of the internal molten steel, and sending the measurement result to the robot. The result of the measurement by the vision collecting device is zAt presentAnd converting the coordinate into a coordinate under a base coordinate of the temperature measurement sampling robot.
S3: temperature measurement sampling robot according to zAt presentAnd planning a gun discharging path so as to carry out temperature measurement sampling operation.
In some implementations, the specific method for planning the gun dropping path is as follows:
s31: the maximum value of the depth of the robot in the gun in the constraint space is obtained by simulation through measuring the field environment or arranging a drawing, namely the measuring gun can reach the lowest point in the ladle.
S32: the robot can contact steel slag and molten steel in the gun-off process, and the posture of the robot is required to be kept unchanged when the gun is off, so that the phenomenon that the measuring gun is slidingly swept in the molten steel due to the change of the posture of the measuring gun in the measuring process to cause the deformation of the measuring gun or the overload alarm of the robot is avoided. Meanwhile, due to the limitation of space and environment, the robot is difficult to ideally insert the measuring gun into the molten steel in a posture vertical to the molten steel level in the gun discharging process.
Therefore, the lower gun direction of the measuring gun is set according to space and environmental limitations and the lowest point of the measuring gun in the ladle.
Then, according to the gun-down direction, the starting insertion point p is set1(x1,y1,z1,q1,q2,q3,q4) And ending insertion point p2(x2,y2,z2,q1,q2,q3,q4) Wherein p is1And p2The pose of the robot of the points remains the same, i.e. p1.rot=p2Rot, wherein p1And p2Are coordinates relative to the robot base coordinate system (x, y, z).
S33: due to p1Point sum p2The point postures are consistent, and p is established1Point sum p2The points x, y are linear functions with respect to z, i.e. x ═ fx(z),y=fy(z) a molten steel level height z transmitted visually when receiving the visual signalAt presentWhen it is trueTime-calculating the current temperature measuring point pTemperature measurement(fx(zAt present),fy(zAt present),zAt present,q1,q2,q3,q4) I.e. the path of the robot descending the gun is in a straight line from p1To pTemperature measurement
Referring to fig. 2, the present invention provides a temperature measurement sampling robot path planning system, which includes a temperature measurement sampling robot 1, a measuring gun 2 disposed on the temperature measurement sampling robot 1, a vision collecting device 3, and a control module 4. The measuring gun 2 is arranged on a flange at the tail end of the temperature measuring and sampling robot 1.
The control module 4 is used for controlling the movement path of the flange at the tail end of the temperature measurement sampling robot 1. In this embodiment, the vision collecting device 3 is a binocular camera, when the binocular camera collects the liquid level height of molten steel, the liquid level height is sent to the control module 4, the control module 4 calculates the path of the molten steel falling from the gun, and the temperature measuring and sampling robot 1 moves according to the calculation result to realize temperature measuring and sampling.
The present embodiment also provides a computer-readable storage medium, on which a computer program is stored, and when the computer program is executed by a processor, the method for planning a path of a thermometric sampling robot as described in any one of the above embodiments is implemented.
In summary, in the embodiment, the visual acquisition device is used for detecting the liquid level height of the molten steel in the ladle, so that the height is transmitted to the robot; the linear function is used for calculating the coordinates of the target point of the robot at the current height, the robot is guided to move, the successful temperature measurement sampling operation is achieved, and the success rate and the accuracy of the temperature measurement sampling robot for measuring the temperature of the molten steel are improved.
The foregoing embodiments are merely illustrative of the principles and utilities of the present invention and are not intended to limit the invention. Any person skilled in the art can modify or change the above-mentioned embodiments without departing from the spirit and scope of the present invention. Accordingly, it is intended that all equivalent modifications or changes which can be made by those skilled in the art without departing from the spirit and technical spirit of the present invention be covered by the claims of the present invention.

Claims (8)

1. A path planning method of a temperature measurement sampling robot is characterized in that a vision acquisition device is provided, and the method comprises the following steps: the method comprises the steps of obtaining the liquid level height of molten steel in a ladle through a visual acquisition device, and planning a gun falling path of a temperature measurement sampling robot according to the liquid level height of the molten steel.
2. The path planning method for the thermometric sampling robot according to claim 1, wherein: the visual acquisition device is arranged at the working end of the temperature measurement sampling robot, and the temperature measurement sampling robot moves the visual acquisition device to enable the liquid level of the molten steel in the steel ladle to be within the acquisition range of the visual acquisition device.
3. The path planning method for the thermometric sampling robot according to claim 1, wherein: and calibrating the vision acquisition device to obtain a transformation matrix of the coordinate system of the vision acquisition device relative to the base coordinate of the temperature measurement sampling robot.
4. The path planning method for the thermometric sampling robot according to claim 1, wherein: in the gun falling process, the posture of the temperature measurement sampling robot is kept unchanged, the gun falling direction of the temperature measurement sampling robot is obtained according to the field environment, a function of the gun falling direction relative to the height direction is established, and the temperature measurement point p is obtained according to the liquid level height of the molten steel in the ladle and the function of the gun falling directionTemperature measurementThe coordinates of (a).
5. The path planning method for the thermometric sampling robot according to claim 4, wherein: and obtaining the lowest point of the temperature measuring and sampling robot for putting the gun into the ladle according to the site environment or the process layout drawing, and obtaining the gun putting direction of the temperature measuring and sampling robot according to the site environment and the lowest point.
6. The path planning method for the thermometric sampling robot according to claim 4, wherein: the preset starting insertion point isp1(x1,y1,z1,q1,q2,q3,q4) And ending insertion point p2(x2,y2,z2,q1,q2,q3,q4) The starting insertion point and the ending insertion point are both in the gun descending direction;
wherein the coordinate system of the temperature measuring and sampling robot is (x, y, z), z is the direction of the liquid level height of the molten steel, and x is1,y1,z1Is p1Coordinate under coordinate system of temperature measuring and sampling robot, x2,y2,z2Is p2Coordinates in the coordinate System of the thermometric sampling robot, q1,q2,q3,q4Is a quaternion of the robot posture,
according to p1And p2Obtaining x ═ fx(z),y=fy(z) according to the height z of the liquid level of the molten steel in the ladle obtained by the vision acquisition deviceAt presentAnd x ═ fx(z),y=fy(z) obtaining a temperature measurement point pTemperature measurementCoordinate of (a), p1To pTemperature measurementThe connecting line between the two is the gun-discharging path of the temperature-measuring sampling robot.
7. A path planning system of a temperature measurement sampling robot is used for implementing the path planning method of the temperature measurement sampling robot as claimed in any one of claims 1-6, and comprises the following steps:
the temperature measurement sampling robot is provided with a measuring gun;
the vision acquisition device is arranged on the measuring gun and can move along with the measuring gun;
and the control module is connected with the temperature measurement sampling robot and the vision acquisition device.
8. A computer-readable storage medium, on which a computer program is stored, which, when executed by a processor, implements a method for path planning for a thermometric sampling robot according to any one of claims 1 to 6.
CN202111433142.3A 2021-11-29 2021-11-29 Path planning method and system for temperature measuring sampling robot and readable storage medium Active CN114237230B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111433142.3A CN114237230B (en) 2021-11-29 2021-11-29 Path planning method and system for temperature measuring sampling robot and readable storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111433142.3A CN114237230B (en) 2021-11-29 2021-11-29 Path planning method and system for temperature measuring sampling robot and readable storage medium

Publications (2)

Publication Number Publication Date
CN114237230A true CN114237230A (en) 2022-03-25
CN114237230B CN114237230B (en) 2024-07-26

Family

ID=80751779

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111433142.3A Active CN114237230B (en) 2021-11-29 2021-11-29 Path planning method and system for temperature measuring sampling robot and readable storage medium

Country Status (1)

Country Link
CN (1) CN114237230B (en)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101975679A (en) * 2010-09-20 2011-02-16 河北省首钢迁安钢铁有限责任公司 Exactly temperature-measuring and sampling system of molten steel and method thereof
CN201837542U (en) * 2010-09-20 2011-05-18 河北省首钢迁安钢铁有限责任公司 Sampling device capable of automatically measuring temperature and determining oxygen
CN110450169A (en) * 2019-09-03 2019-11-15 中冶赛迪工程技术股份有限公司 A kind of robot thermometric sampling control method and control system
US20210046356A1 (en) * 2015-06-23 2021-02-18 Ipcomm Llc Method and Apparatus for Early Detection of Diabetic Foot Disorders by Analyzing Foot Temperature and Vertical and Shear Forces on Feet
CN112611480A (en) * 2020-11-27 2021-04-06 中冶赛迪工程技术股份有限公司 Temperature measurement sampling method and system
CN113686449A (en) * 2021-08-19 2021-11-23 中冶赛迪工程技术股份有限公司 Robot temperature measurement is taken a sample with range finding temperature measurement rifle

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101975679A (en) * 2010-09-20 2011-02-16 河北省首钢迁安钢铁有限责任公司 Exactly temperature-measuring and sampling system of molten steel and method thereof
CN201837542U (en) * 2010-09-20 2011-05-18 河北省首钢迁安钢铁有限责任公司 Sampling device capable of automatically measuring temperature and determining oxygen
US20210046356A1 (en) * 2015-06-23 2021-02-18 Ipcomm Llc Method and Apparatus for Early Detection of Diabetic Foot Disorders by Analyzing Foot Temperature and Vertical and Shear Forces on Feet
CN110450169A (en) * 2019-09-03 2019-11-15 中冶赛迪工程技术股份有限公司 A kind of robot thermometric sampling control method and control system
CN112611480A (en) * 2020-11-27 2021-04-06 中冶赛迪工程技术股份有限公司 Temperature measurement sampling method and system
CN113686449A (en) * 2021-08-19 2021-11-23 中冶赛迪工程技术股份有限公司 Robot temperature measurement is taken a sample with range finding temperature measurement rifle

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
张华;谢植;: "钢水连续测温传感器动态测温的仿真研究", 仪器仪表学报, no. 10 *

Also Published As

Publication number Publication date
CN114237230B (en) 2024-07-26

Similar Documents

Publication Publication Date Title
CN107314778B (en) Calibration method, device and system for relative attitude
EP2788714B1 (en) Coordinate measuring machine having a camera
CN201837542U (en) Sampling device capable of automatically measuring temperature and determining oxygen
US20160184997A1 (en) Image Processing Apparatus, Image Processing System, Image Processing Method, And Computer Program
CN102399933B (en) Automatic control method for converter blowing low-carbon steel oxygen lance
CN113021358A (en) Method and device for calibrating origin of coordinate system of mechanical arm tool and electronic equipment
CN108677746A (en) The automatic accurate adjustment method and system of swivel continuous beam for flat turn method construction
KR101265552B1 (en) Easy teaching apparatus for welding robot and welding method using the same
CN113478491B (en) Method and system for controlling position of mechanical arm, robot and storage medium
CN114237230A (en) Path planning method and system of temperature measurement sampling robot and readable storage medium
CN111102929A (en) Intelligent detector for furnace tube abrasion of thermal power plant
CN203323708U (en) Device measuring thickness of furnace lining
CN110238851B (en) Mobile robot and rapid calibration method and system thereof
JPH08272425A (en) Method to teach coordinate system to robot in non-contact
CN113781558B (en) Robot vision locating method with decoupling gesture and position
CN114310906B (en) Coordinate conversion method in double-robot automatic measurement and scribing system
CN116008281A (en) Defect detection system, method, equipment and medium for boiler water wall
CN110977612B (en) CNC (computer numerical control) machining online measurement error correction method and system
CN216524095U (en) Thermal state monitoring system for empty ladle and tapping process of steel ladle
CN103045795A (en) Converter sublance liquid level measurement system
CN110186374B (en) Method for measuring size of hearth when opening degree of converter mouth is larger than radius of hearth
CN112611480A (en) Temperature measurement sampling method and system
CN107796306B (en) Quadratic element measuring instrument and measuring method
CN108593539A (en) A kind of contact metal semi-solid thixotropic behavior measuring device and its measurement method
CN105728670A (en) Steel ladle liquid level monitoring system and method

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant