CN112264996A - Steel grabbing machine positioning control method and system - Google Patents
Steel grabbing machine positioning control method and system Download PDFInfo
- Publication number
- CN112264996A CN112264996A CN202011107506.4A CN202011107506A CN112264996A CN 112264996 A CN112264996 A CN 112264996A CN 202011107506 A CN202011107506 A CN 202011107506A CN 112264996 A CN112264996 A CN 112264996A
- Authority
- CN
- China
- Prior art keywords
- information
- chassis
- steel
- end effector
- axis
- 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
Links
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
-
- 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
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- 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
- B25J9/1679—Programme controls characterised by the tasks executed
Abstract
The invention provides a steel grabbing machine positioning control method and a steel grabbing machine positioning control system, wherein the method comprises the following steps: acquiring first associated information of a steel grabbing machine, wherein the first associated information at least comprises one of the following information: attitude information of the chassis, position information of the chassis; establishing a mapping relation between a chassis of the steel grabbing machine and an end effector of the steel grabbing machine, and determining second associated information through the first associated information and the mapping relation, wherein the second associated information at least comprises one of the following information: attitude information of the end effector, position information of the end effector; controlling the steel grabbing machine according to the first associated information and the second associated information; according to the method, the first associated information of the steel grabbing machine is obtained, the mapping relation between the chassis of the steel grabbing machine and the end effector of the steel grabbing machine is established, the second associated information is determined through the first associated information and the mapping relation, the steel grabbing machine is controlled, the simultaneous obtaining of the positions and the postures of the chassis of the steel grabbing machine and the end effector is achieved, and the accuracy is high.
Description
Technical Field
The invention relates to the field of detection control, in particular to a steel grabbing machine positioning control method and system.
Background
In the process of steel scrap operation in a steel plant, a steel grabbing machine is usually used for grabbing, loading and other work on materials such as steel scrap, at present, the steel grabbing machine is usually positioned in a manual mode, the size of the steel grabbing machine is large, the steel grabbing machine is not convenient to position in the manual mode, the pose of a chassis of the steel grabbing machine and the pose of an end effector cannot be obtained simultaneously, the automation degree is low, the working efficiency is low, and potential safety hazards are easily generated.
Disclosure of Invention
In view of the above disadvantages of the prior art, the present invention provides a method and a system for controlling positioning of a steel gripper, so as to solve the problem that it is inconvenient to simultaneously obtain the positions and postures of a chassis and an end effector of the steel gripper in a manual manner in the prior art.
The invention provides a steel grabbing machine positioning control method, which comprises the following steps:
acquiring first associated information of a steel grabbing machine, wherein the first associated information at least comprises one of the following information: attitude information of the chassis, position information of the chassis;
establishing a mapping relation between a chassis of the steel grabbing machine and an end effector of the steel grabbing machine, and determining second associated information through the first associated information and the mapping relation, wherein the second associated information at least comprises one of the following information: attitude information of the end effector, position information of the end effector;
and controlling the steel grabbing machine according to the first associated information and the second associated information.
Optionally, the obtaining mode of the attitude information of the chassis includes:
acquiring initial angular velocity information and real-time angular velocity information of a chassis of a steel grab, and determining the posture of the chassis according to the initial angular velocity information and the real-time angular velocity information, wherein the real-time angular velocity information is acquired through an inertial sensor.
Optionally, the initial angular velocity information includes: angle information of the chassis on a reference coordinate system in an initial state, wherein the angle information comprises: (theta)x0,θy0,θz0) Wherein, thetax0、θy0、θz0The included angles of the chassis and the x, y and z axes of the reference coordinate system in the initial state are respectively included; the real-time angular velocity information includes: step sampling time, and angular speed of the inertial sensor on x, y and z axes of the reference coordinate system during sampling.
Optionally, the mathematical expression of the step of determining the attitude of the chassis according to the initial angular velocity information and the real-time angular velocity information is as follows:
wherein, tnIs the step size sampling time theta'xn、θ′yn、θ′znAngular velocities of the inertial sensor in the x, y and z axes of the reference coordinate system at the time of sampling, thetax0、θy0、θz0Respectively the included angles theta between the chassis and the x, y and z axes of the reference coordinate system in the initial statexk、θyk、θzkThe included angles of the chassis and the x, y and z axes of the reference coordinate system in a real-time state are respectively included.
Optionally, the obtaining method of the position information of the chassis includes:
acquiring initial position information of the chassis, controlling a position sensor to acquire real-time position information of the chassis, and determining the position of the chassis according to the initial position information and the real-time position information.
Optionally, the initial position information includes position coordinates of the chassis on a reference coordinate system in an initial state, and the real-time position information includes a real-time position signal of the chassis, which is acquired by the position sensor.
Optionally, the step of establishing a mapping relationship between a chassis of the steel grasping machine and an end effector of the steel grasping machine, and determining second associated information according to the first associated information and the mapping relationship includes:
according to the size of the steel grabbing machine, establishing a mapping relation between a chassis of the steel grabbing machine and an end effector of the steel grabbing machine;
and acquiring the rotation angle of each joint of the steel grasping machine through an inertial sensor, and determining the position and the posture of the end effector of the steel grasping machine relative to the chassis according to the first correlation information, the mapping relation and the rotation angle.
Optionally, the step of obtaining the rotation angle of each joint of the steel grasping machine through an inertial sensor, and determining the position and the posture of the end effector of the steel grasping machine relative to the chassis according to the first correlation information, the mapping relationship and the rotation angle includes:
according to the first correlation information and the mapping relation, respectively establishing a motion coordinate system at each joint of the steel grabbing machine, and acquiring a homogeneous transformation matrix adjacent to the motion coordinate system, and further acquiring a rotation matrix of the end effector relative to the chassis, wherein the mathematical expression of the homogeneous transformation matrix is as follows:
wherein, the
A homogeneous transformation matrix theta for the ith motion coordinate system and the (i-1) th motion coordinate systemiIs surrounded by ziAxis from xi-1Axis to xiAngle of the axis, c θi＝cosθi，sθi＝sinθi，αiIs along xiAxis from ziAxis to zi+1Angle of the shaft, cai＝cosαi，sαi＝sinαi，aiIs along xiAxis from ziThe axis moving to zi+1Distance of the axes, diIs along ziAxis from xi-1Axis to xiDistance of axis, ziAxis is the ith motion coordinateZ-axis of system, xi-1The axis is the x axis, x, of the (i-1) th moving coordinate systemiThe axis is the x-axis, z, of the ith motion coordinate systemi+1The axis is the z-axis of the (i + 1) th motion coordinate system.
Optionally, the step of obtaining the rotation angle of each joint of the steel grasping machine through the inertial sensor, and determining the position and the posture of the end effector of the steel grasping machine relative to the chassis according to the first correlation information, the mapping relationship and the rotation angle further includes:
acquiring a rotation matrix of the tail end of the end effector relative to the chassis according to the homogeneous transformation matrix;
the corner of each joint of the steel grabbing machine is obtained through an inertial sensor, and the corner comprises: thetaiAnd alphaiDetermining the position and the posture of the end effector relative to the chassis according to the corner and the homogeneous transformation matrix;
the mathematical expression of the rotation matrix is:
wherein the content of the first and second substances,
is a rotation matrix of the end effector relative to the chassis,
a homogeneous transformation matrix for the 1 st and 0 th of the motion coordinate systems,
and a homogeneous transformation matrix of the ith motion coordinate system and the (i-1) th motion coordinate system.
The invention also provides a steel grabbing machine positioning control system, which comprises:
the first processing module is used for acquiring first associated information of the steel grabbing machine, and the first associated information at least comprises one of the following information: position information of the chassis, posture information of the chassis;
the second processing module is used for establishing a mapping relation between a chassis of the steel grabbing machine and an end effector of the steel grabbing machine, and determining second associated information according to the first associated information and the mapping relation, wherein the second associated information at least comprises one of the following information: position information of the end effector and attitude information of the end effector;
the positioning control module is used for controlling the steel grabbing machine according to the first associated information and the second associated information; the first processing module, the second processing module and the positioning control module are connected in sequence.
The invention has the beneficial effects that: according to the steel grab positioning control method, the first associated information of the steel grab is obtained, the mapping relation between the chassis of the steel grab and the end effector of the steel grab is established, the second associated information is determined according to the first associated information and the mapping relation, the steel grab is controlled according to the first associated information and the second associated information, the position and posture of the chassis and the end effector of the steel grab are positioned, the simultaneous acquisition of the position and the posture of the chassis and the end effector of the steel grab is realized, and the accuracy is high.
Drawings
FIG. 1 is a schematic flow chart of a steel grabbing machine positioning control method in the embodiment of the invention;
FIG. 2 is another schematic flow chart of a steel grabbing machine positioning control method in the embodiment of the invention;
FIG. 3 is a schematic structural diagram of a positioning control system of the steel grasping machine in the embodiment of the 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 is to be noted that the features in the following embodiments and examples may be combined with each other without conflict.
It should be noted that the drawings provided in the following embodiments 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 inventor finds that, at present, in the process of steel scrap operation in a steel plant, a steel grabbing machine is usually positioned in a manual mode, because the steel grabbing machine is large in size, the steel grabbing machine is not convenient to position in the manual mode, the pose of a chassis of the steel grabbing machine and the pose of an end effector cannot be simultaneously obtained, the automation degree is low, the working efficiency is low, and potential safety hazards are easily generated, the inventor provides a steel grabbing machine positioning control method and a steel grabbing machine positioning control system, the mapping relation between the chassis of the steel grabbing machine and the end effector is established by obtaining the pose information of the chassis of the steel grabbing machine and the position information of the end effector, the pose information of the end effector and the position information of the end effector are determined through the first correlation information and the mapping relation, and the steel grabbing machine is positioned and controlled through the pose information of the chassis, the position information of the chassis, the pose information of the end effector and the position information of the end effector, the pose of the chassis and the pose of the end effector of the steel grabbing machine can be obtained simultaneously, the accuracy is high, the unmanned degree is high, and the labor cost is effectively reduced.
As shown in fig. 1, the method for controlling the positioning of the steel grasping machine provided by the embodiment includes:
s101: acquiring first associated information of a steel grabbing machine, wherein the first associated information at least comprises one of the following information: attitude information of the chassis, position information of the chassis;
s102: establishing a mapping relation between a chassis of the steel grabbing machine and an end effector of the steel grabbing machine, and determining second associated information through the first associated information and the mapping relation, wherein the second associated information at least comprises one of the following information: attitude information of the end effector, position information of the end effector;
s103: controlling the steel grabbing machine according to the first associated information and the second associated information; in industrial production, because the positions and postures of the chassis and the end effector of the steel grab machine cannot be determined, and the postures of the chassis and the end effector are mutually influenced, the steel grab machine cannot be accurately positioned and controlled, wherein the postures are the positions and the postures, the mapping relation between the chassis and the end effector of the steel grab machine is established by acquiring first associated information of the steel grab machine, second associated information is determined by the first associated information and the mapping relation, and the steel grab machine is positioned and controlled by the first associated information and the second associated information, so that the unmanned degree is higher, the implementation is more convenient, the simultaneous positioning of the end effector of the chassis of the steel grab machine is realized, the positioning control of the steel grab machine is more accurate, the labor cost is reduced, and the potential safety hazard caused by the inaccurate positioning of the steel grab machine is reduced, for example: the method comprises the steps of obtaining attitude information of a chassis of the steel grabbing machine through an inertial sensor, further determining the attitude of the chassis, obtaining position information of the chassis through a position sensor, further determining the position of the chassis, establishing a mapping relation between the chassis of the steel grabbing machine and an end effector, obtaining position information and attitude information of the end effector of the steel grabbing machine according to the mapping relation, the attitude information and the position information of the chassis, further determining the position and the attitude of the chassis and the end effector of the steel grabbing machine, simultaneously positioning the positions of the chassis and the end effector of the steel grabbing machine, controlling the steel grabbing machine, achieving positioning of the position and the attitude of the steel grabbing machine, being high in accuracy, strong in operability and capable of reducing potential safety hazards.
In some embodiments, the end effector may be a gripper of a steel grasping machine.
In some embodiments, as shown in fig. 2, the method for controlling the positioning of the steel grasping machine provided by the present embodiment includes:
s201: acquiring initial angular velocity information and real-time angular velocity information of a chassis of a steel grab, and determining the posture of the chassis according to the initial angular velocity information and the real-time angular velocity information, wherein the real-time angular velocity information is acquired through an inertial sensor; in some embodiments, the inertial sensor may be an IMU sensor.
In some embodiments, the initial angular velocity information comprises: angle information of the chassis on a reference coordinate system in an initial state, wherein the angle information comprises: (theta)x0,θy0,θz0) Wherein, thetax0、θy0、θz0The included angles of the chassis and the x, y and z axes of the reference coordinate system in the initial state are respectively included; the real-time angular velocity information includes: step sampling time, and angular speed of the inertial sensor on x, y and z axes of the reference coordinate system during sampling.
In some embodiments, the step of determining the attitude of the chassis from the initial angular velocity information and the real-time angular velocity information is mathematically expressed as:
wherein, tnIs the step size sampling time theta'xn、θ′yn、θ′znAngular velocities of the inertial sensor in the x, y and z axes of the reference coordinate system at the time of sampling, thetax0、θy0、θz0Respectively the included angles theta between the chassis and the x, y and z axes of the reference coordinate system in the initial statexk、θyk、θzkThe included angles of the chassis and the x, y and z axes of the reference coordinate system in a real-time state are respectively included.
S202: acquiring initial position information of the chassis, controlling a position sensor to acquire real-time position information of the chassis, and determining the position of the chassis according to the initial position information and the real-time position information; in some embodiments, the location sensor may be a GPS sensor.
In some embodiments, the initial position information includes position coordinates of the chassis on a reference coordinate system in an initial state, and the real-time position information includes real-time position signals of the chassis acquired by the position sensor.
S203: according to the size of the steel grabbing machine, establishing a mapping relation between a chassis of the steel grabbing machine and an end effector of the steel grabbing machine;
and acquiring the rotation angle of each joint of the steel grasping machine through an inertial sensor, and determining the position and the posture of the end effector of the steel grasping machine relative to the chassis according to the first correlation information, the mapping relation and the rotation angle.
In some embodiments, the step of obtaining the rotation angle of each joint of the steel grasping machine through an inertial sensor, and determining the position and the posture of the end effector of the steel grasping machine relative to the chassis according to the first correlation information, the mapping relation and the rotation angle comprises the following steps:
according to the first correlation information and the mapping relation, respectively establishing a motion coordinate system at each joint of the steel grabbing machine, and acquiring a homogeneous transformation matrix adjacent to the motion coordinate system, and further acquiring a rotation matrix of the end effector relative to the chassis, wherein the mathematical expression of the homogeneous transformation matrix is as follows:
wherein, the
A homogeneous transformation matrix theta for the ith motion coordinate system and the (i-1) th motion coordinate systemiIs surrounded by ziAxis from xi-1Axis to xiAngle of the axis, c θi＝cosθi，sθi＝sinθi，αiIs along xiAxis from ziAxis to zi+1Angle of the shaft, cai＝cosαi，sαi＝sinαi，aiIs along xiAxis from ziThe axis moving to zi+1Distance of the axes, diIs along ziAxis from xi-1Axis to xiDistance of axis, ziAxis being the ith said movementZ-axis, x of the coordinate systemi-1The axis is the x axis, x, of the (i-1) th moving coordinate systemiThe axis is the x-axis, z, of the ith motion coordinate systemi+1The axis is the z-axis of the (i + 1) th motion coordinate system, for example: according to the first correlation information and the mapping relation, respectively establishing a motion coordinate system at each joint of the steel grabbing machine, wherein the motion coordinate systems are respectively positioned on the joints of each connecting rod of the steel grabbing machine, acquiring a homogeneous transformation matrix of adjacent motion coordinate systems, describing the relative position and the attitude direction between the adjacent motion coordinate systems through a homogeneous coordinate, and further acquiring a rotation matrix of the end effector relative to the chassis.
S204: acquiring a rotation matrix of the tail end of the end effector relative to the chassis according to the homogeneous transformation matrix;
the corner of each joint of the steel grabbing machine is obtained through an inertial sensor, and the corner comprises: thetaiAnd alphaiDetermining the position and the posture of the end effector relative to the chassis according to the corner and the homogeneous transformation matrix;
the mathematical expression of the rotation matrix is:
wherein the content of the first and second substances,
is a rotation matrix of the end effector relative to the chassis,
a homogeneous transformation matrix for the 1 st and 0 th of the motion coordinate systems,
and a homogeneous transformation matrix of the ith motion coordinate system and the (i-1) th motion coordinate system.
In some embodiments, the position information and the attitude information of the steel grabbing machine can be acquired through a position sensor and an inertial sensor, the position and the attitude of a chassis of the steel grabbing machine and the position and the attitude of an end effector at the tail end of the steel grabbing machine are calculated according to the position information and the attitude information, the high-precision positioning of the steel grabbing machine is realized, and the steel grabbing machine is controlled to realize unmanned steel grabbing operation.
This embodiment still provides a grab steel machine positioning control system, includes:
the first processing module is used for acquiring first associated information of the steel grabbing machine, and the first associated information at least comprises one of the following information: position information of the chassis, posture information of the chassis;
the second processing module is used for establishing a mapping relation between a chassis of the steel grabbing machine and an end effector of the steel grabbing machine, and determining second associated information according to the first associated information and the mapping relation, wherein the second associated information at least comprises one of the following information: position information of the end effector and attitude information of the end effector;
the positioning control module is used for controlling the steel grabbing machine according to the first associated information and the second associated information; the first processing module, the second processing module and the positioning control module are connected in sequence; the method comprises the steps of establishing a mapping relation between a chassis of the steel grab and an end effector by acquiring first associated information of the steel grab, determining second associated information by the first associated information and the mapping relation, and positioning the pose of the steel grab by the first associated information and the second associated information, so that the unmanned degree is high, the implementation is convenient, the simultaneous positioning of the end effector of the chassis of the steel grab is realized, and the positioning control of the steel grab is more accurate.
In some embodiments, further comprising: the power supply module is used for providing operating voltage and the communication module is used for transmitting data information.
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 (10)
1. A steel grabbing machine positioning control method is characterized by comprising the following steps:
acquiring first associated information of a steel grabbing machine, wherein the first associated information at least comprises one of the following information: attitude information of the chassis, position information of the chassis;
establishing a mapping relation between a chassis of the steel grabbing machine and an end effector of the steel grabbing machine, and determining second associated information through the first associated information and the mapping relation, wherein the second associated information at least comprises one of the following information: attitude information of the end effector, position information of the end effector;
and controlling the steel grabbing machine according to the first associated information and the second associated information.
2. The steel grab positioning control method according to claim 1, wherein the acquisition mode of the attitude information of the chassis comprises the following steps:
acquiring initial angular velocity information and real-time angular velocity information of a chassis of a steel grab, and determining the posture of the chassis according to the initial angular velocity information and the real-time angular velocity information, wherein the real-time angular velocity information is acquired through an inertial sensor.
3. The steel grab positioning control method according to claim 2, wherein the initial angular velocity information includes: angle information of the chassis on a reference coordinate system in an initial state, wherein the angle information comprises: (theta)x0,θy0,θz0) Wherein, thetax0、θy0、θz0The included angles of the chassis and the x, y and z axes of the reference coordinate system in the initial state are respectively included; the real-time angular velocity information includes: step sampling time, and angular speed of the inertial sensor on x, y and z axes of the reference coordinate system during sampling.
4. The steel grab positioning control method according to claim 3, wherein the mathematical expression of the step of determining the attitude of the chassis from the initial angular velocity information and the real-time angular velocity information is:
wherein, tnIs the step size sampling time theta'xn、θ′yn、θ′znAngular velocities of the inertial sensor in the x, y and z axes of the reference coordinate system at the time of sampling, thetax0、θy0、θz0Respectively the included angles theta between the chassis and the x, y and z axes of the reference coordinate system in the initial statexk、θyk、θzkThe included angles of the chassis and the x, y and z axes of the reference coordinate system in a real-time state are respectively included.
5. The steel grab positioning control method according to claim 1, wherein the acquisition mode of the position information of the chassis comprises the following steps:
acquiring initial position information of the chassis, controlling a position sensor to acquire real-time position information of the chassis, and determining the position of the chassis according to the initial position information and the real-time position information.
6. The steel grab positioning control method according to claim 5, wherein the initial position information comprises position coordinates of the chassis on a reference coordinate system in an initial state, and the real-time position information comprises real-time position signals of the chassis, which are acquired by the position sensor.
7. The steel grab positioning control method as claimed in claim 1, wherein the step of establishing a mapping relationship between a chassis of the steel grab and an end effector of the steel grab, and determining second associated information through the first associated information and the mapping relationship comprises:
according to the size of the steel grabbing machine, establishing a mapping relation between a chassis of the steel grabbing machine and an end effector of the steel grabbing machine;
and acquiring the rotation angle of each joint of the steel grasping machine through an inertial sensor, and determining the position and the posture of the end effector of the steel grasping machine relative to the chassis according to the first correlation information, the mapping relation and the rotation angle.
8. The steel grab positioning control method as claimed in claim 7, wherein the step of obtaining the rotation angle of each joint of the steel grab through an inertial sensor and determining the position and the posture of the end effector of the steel grab relative to the chassis according to the first correlation information, the mapping relation and the rotation angle comprises the steps of:
according to the first correlation information and the mapping relation, respectively establishing a motion coordinate system at each joint of the steel grabbing machine, and acquiring a homogeneous transformation matrix adjacent to the motion coordinate system, and further acquiring a rotation matrix of the end effector relative to the chassis, wherein the mathematical expression of the homogeneous transformation matrix is as follows:
wherein, the
A homogeneous transformation matrix theta for the ith motion coordinate system and the (i-1) th motion coordinate systemiIs surrounded by ziAxis from xi-1Axis to xiAngle of the axis, c θi＝cosθi，sθi＝sinθi，αiIs along xiAxis from ziAxis to zi+1Angle of the shaft, cai＝cosαi，sαi＝sinαi，aiIs along xiAxis from ziThe axis moving to zi+1Distance of the axes, diIs a rimIs at ziAxis from xi-1Axis to xiDistance of axis, ziThe axis is the z-axis, x, of the ith motion coordinate systemi-1The axis is the x axis, x, of the (i-1) th moving coordinate systemiThe axis is the x-axis, z, of the ith motion coordinate systemi+1The axis is the z-axis of the (i + 1) th motion coordinate system.
9. The steel grab positioning control method as claimed in claim 8, wherein the step of obtaining the rotation angle of each joint of the steel grab through an inertial sensor and determining the position and posture of the end effector of the steel grab relative to the chassis according to the first correlation information, the mapping relation and the rotation angle further comprises the steps of:
acquiring a rotation matrix of the tail end of the end effector relative to the chassis according to the homogeneous transformation matrix;
the corner of each joint of the steel grabbing machine is obtained through an inertial sensor, and the corner comprises: thetaiAnd alphaiDetermining the position and the posture of the end effector relative to the chassis according to the corner and the homogeneous transformation matrix;
the mathematical expression of the rotation matrix is:
wherein the content of the first and second substances,
is a rotation matrix of the end effector relative to the chassis,
a homogeneous transformation matrix for the 1 st and 0 th of the motion coordinate systems,
for the ith motion coordinate system and the (i-1) th motion coordinate systemAnd a homogeneous transformation matrix of the moving coordinate system.
10. The utility model provides a grab steel machine positioning control system which characterized in that includes:
the first processing module is used for acquiring first associated information of the steel grabbing machine, and the first associated information at least comprises one of the following information: position information of the chassis, posture information of the chassis;
the second processing module is used for establishing a mapping relation between a chassis of the steel grabbing machine and an end effector of the steel grabbing machine, and determining second associated information according to the first associated information and the mapping relation, wherein the second associated information at least comprises one of the following information: position information of the end effector and attitude information of the end effector;
the positioning control module is used for controlling the steel grabbing machine according to the first associated information and the second associated information; the first processing module, the second processing module and the positioning control module are connected in sequence.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011107506.4A CN112264996B (en) | 2020-10-16 | 2020-10-16 | Steel grabbing machine positioning control method and system |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011107506.4A CN112264996B (en) | 2020-10-16 | 2020-10-16 | Steel grabbing machine positioning control method and system |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN112264996A true CN112264996A (en) | 2021-01-26 |
| CN112264996B CN112264996B (en) | 2022-06-14 |
Family
ID=74337596
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202011107506.4A Active CN112264996B (en) | 2020-10-16 | 2020-10-16 | Steel grabbing machine positioning control method and system |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN112264996B (en) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113934174A (en) * | 2021-10-22 | 2022-01-14 | 中冶赛迪上海工程技术有限公司 | Steel grabbing control method and system |
| CN113928847A (en) * | 2021-10-26 | 2022-01-14 | 中冶赛迪上海工程技术有限公司 | Steel grabbing machine posture determining method and system |
Citations (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN201679027U (en) * | 2010-03-16 | 2010-12-22 | 宝钢集团新疆八一钢铁有限公司 | Improved steel grabbing machine |
| CN103702607A (en) * | 2011-07-08 | 2014-04-02 | 修复型机器人公司 | Calibration and transformation of a camera system's coordinate system |
| CN105232155A (en) * | 2015-09-08 | 2016-01-13 | 微创（上海）医疗机器人有限公司 | Surgical robot adjustment system |
| CN206615762U (en) * | 2017-03-16 | 2017-11-07 | 山东永平再生资源股份有限公司 | A kind of feeding device for gantry cutter |
| CN107961078A (en) * | 2017-12-18 | 2018-04-27 | 微创（上海）医疗机器人有限公司 | Surgical robot system and its operating theater instruments |
| CN108724190A (en) * | 2018-06-27 | 2018-11-02 | 西安交通大学 | A kind of industrial robot number twinned system emulation mode and device |
| JP2019022916A (en) * | 2017-07-24 | 2019-02-14 | セイコーエプソン株式会社 | Robot control device, robot control method, robot system, and simulation device |
| CN109911481A (en) * | 2019-01-03 | 2019-06-21 | 上海交通大学 | The storehouse frame target visual recognition positioning method and system patched towards metallurgical robot |
| US20190224846A1 (en) * | 2016-07-15 | 2019-07-25 | Fastbrick Ip Pty Ltd | Dynamic compensation of a robot arm mounted on a flexble arm |
| CN110303472A (en) * | 2018-03-27 | 2019-10-08 | 迪尔公司 | Movable type mechanical is converted into high precision machines people |
| CN110464471A (en) * | 2019-09-10 | 2019-11-19 | 深圳市精锋医疗科技有限公司 | The control method of operating robot and its end instrument, control device |
-
2020
- 2020-10-16 CN CN202011107506.4A patent/CN112264996B/en active Active
Patent Citations (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN201679027U (en) * | 2010-03-16 | 2010-12-22 | 宝钢集团新疆八一钢铁有限公司 | Improved steel grabbing machine |
| CN103702607A (en) * | 2011-07-08 | 2014-04-02 | 修复型机器人公司 | Calibration and transformation of a camera system's coordinate system |
| CN105232155A (en) * | 2015-09-08 | 2016-01-13 | 微创（上海）医疗机器人有限公司 | Surgical robot adjustment system |
| US20190224846A1 (en) * | 2016-07-15 | 2019-07-25 | Fastbrick Ip Pty Ltd | Dynamic compensation of a robot arm mounted on a flexble arm |
| CN206615762U (en) * | 2017-03-16 | 2017-11-07 | 山东永平再生资源股份有限公司 | A kind of feeding device for gantry cutter |
| JP2019022916A (en) * | 2017-07-24 | 2019-02-14 | セイコーエプソン株式会社 | Robot control device, robot control method, robot system, and simulation device |
| CN107961078A (en) * | 2017-12-18 | 2018-04-27 | 微创（上海）医疗机器人有限公司 | Surgical robot system and its operating theater instruments |
| CN110303472A (en) * | 2018-03-27 | 2019-10-08 | 迪尔公司 | Movable type mechanical is converted into high precision machines people |
| CN108724190A (en) * | 2018-06-27 | 2018-11-02 | 西安交通大学 | A kind of industrial robot number twinned system emulation mode and device |
| CN109911481A (en) * | 2019-01-03 | 2019-06-21 | 上海交通大学 | The storehouse frame target visual recognition positioning method and system patched towards metallurgical robot |
| CN110464471A (en) * | 2019-09-10 | 2019-11-19 | 深圳市精锋医疗科技有限公司 | The control method of operating robot and its end instrument, control device |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113934174A (en) * | 2021-10-22 | 2022-01-14 | 中冶赛迪上海工程技术有限公司 | Steel grabbing control method and system |
| CN113928847A (en) * | 2021-10-26 | 2022-01-14 | 中冶赛迪上海工程技术有限公司 | Steel grabbing machine posture determining method and system |
Also Published As
| Publication number | Publication date |
|---|---|
| CN112264996B (en) | 2022-06-14 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN109822574B (en) | Industrial robot end six-dimensional force sensor calibration method | |
| CN108638069B (en) | Method for controlling accurate motion of tail end of mechanical arm | |
| CN107139178B (en) | Unmanned aerial vehicle and vision-based grabbing method thereof | |
| CN107443382B (en) | Industrial robot structure parameter error identification and compensation method | |
| CN112264996B (en) | Steel grabbing machine positioning control method and system | |
| US10166673B2 (en) | Portable apparatus for controlling robot and method thereof | |
| CN113021358B (en) | Method and device for calibrating origin of coordinate system of mechanical arm tool and electronic equipment | |
| CN108839025A (en) | A kind of motion planning method and device of mobile mechanical arm | |
| CN113715016B (en) | Robot grabbing method, system, device and medium based on 3D vision | |
| CN106695803A (en) | Continuous robot posture control system | |
| CN111775145A (en) | Control system of series-parallel robot | |
| CN113352300A (en) | Spraying robot demonstrator and method | |
| CN110181522B (en) | Five-degree-of-freedom head-end symmetric mechanical arm inverse kinematics calculation optimization method | |
| JP2009226552A (en) | Method for teaching redundant robot | |
| CN110962127A (en) | Auxiliary calibration device for tail end pose of mechanical arm and calibration method thereof | |
| CN114012507A (en) | Identification method for position-independent errors of double rotating shafts of cradle type five-axis machine tool | |
| CN109048911B (en) | Robot vision control method based on rectangular features | |
| CN113084791B (en) | Mechanical arm control method, mechanical arm control device and terminal equipment | |
| CN116852359A (en) | TCP (Transmission control protocol) quick calibration device and method based on robot hand teaching device | |
| CN111702787A (en) | Man-machine cooperation control system and control method | |
| CN115674277A (en) | Double-mechanical-arm device with hand-eye camera and control method thereof | |
| JPH0847881A (en) | Method of remotely controlling robot | |
| JP7372161B2 (en) | Manipulators, automation methods and programs | |
| CN116100562B (en) | Visual guiding method and system for multi-robot cooperative feeding and discharging | |
| CN112214028A (en) | Underwater robot pose control method based on OpenMV |
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 |