[go: up one dir, main page]

CN115030247A - Method and device for correcting pose information of boom and excavator - Google Patents

Method and device for correcting pose information of boom and excavator Download PDF

Info

Publication number
CN115030247A
CN115030247A CN202210590698.1A CN202210590698A CN115030247A CN 115030247 A CN115030247 A CN 115030247A CN 202210590698 A CN202210590698 A CN 202210590698A CN 115030247 A CN115030247 A CN 115030247A
Authority
CN
China
Prior art keywords
arm
support
information
arm support
correcting
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
CN202210590698.1A
Other languages
Chinese (zh)
Other versions
CN115030247B (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.)
Sany Heavy Machinery Ltd
Original Assignee
Sany Heavy Machinery 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 Sany Heavy Machinery Ltd filed Critical Sany Heavy Machinery Ltd
Priority to CN202210590698.1A priority Critical patent/CN115030247B/en
Publication of CN115030247A publication Critical patent/CN115030247A/en
Application granted granted Critical
Publication of CN115030247B publication Critical patent/CN115030247B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/431Control of dipper or bucket position; Control of sequence of drive operations for bucket-arms, front-end loaders, dumpers or the like
    • E02F3/432Control of dipper or bucket position; Control of sequence of drive operations for bucket-arms, front-end loaders, dumpers or the like for keeping the bucket in a predetermined position or attitude

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Operation Control Of Excavators (AREA)

Abstract

The application discloses a method and a device for correcting arm support pose information and an excavator, wherein coordinate information of a free end of an arm support in a preset state of the arm support is obtained; and measuring the angle information of the arm frame in a plurality of sections under a preset state; correcting parameters of a motion model of the arm support according to the coordinate information and the angle information; the angle information comprises the pitching angles of the multiple sections of support arms, and the motion model represents the corresponding relation between the coordinate information of the free end of the arm support and the angle information of the multiple sections of arm support; the method and the device have the advantages that the coordinate information of the free end of the arm support in a specific preset state and the angle information of the support arm are measured, so that the parameters of the motion model of the arm support are corrected according to the measured value in the preset state, the correction of the parameters of the motion model can be simply realized, the regular maintenance of professional maintainers is not needed, the labor cost and time are saved, the correction can be performed before operation to ensure the operation precision of the arm support, and the operation efficiency and precision are improved.

Description

Arm support pose information correction method and device and excavator
Technical Field
The application relates to the technical field of arm supports of engineering mechanical equipment, in particular to a method and a device for correcting arm support pose information and an excavator.
Background
Engineering machinery such as excavators and the like play an important role in the aspects of infrastructure, mining, real estate development, water conservancy and the like, so that the engineering machinery is widely applied to modern industry. Because the system of the excavator has the characteristics of time-varying property, strong dynamic coupling and flow coupling during working, nonlinearity of multiple inputs and multiple outputs, possibility of wide-range change of system parameters and the like, the research on joint trajectory control for realizing high precision and strong robustness of the excavator becomes a hot spot in the field of excavator control.
The excavator mainly comprises a movable arm, an arm and a bucket, wherein the movable arm, the arm and the bucket are main execution mechanisms for realizing the functions of ditching, leveling, loading and the like, and the bucket is positioned and executed by adjusting the angles of three-section structures of the movable arm, the arm and the bucket. Under the trend of engineering machinery intellectualization, a control system of the excavator needs to observe and acquire working device pose information with high accuracy and good robustness through a simplified sensor, so as to realize automatic operation.
However, due to the large size and the high degree of freedom of the excavator, the excavator works for a long time, especially in a severe environment, the performance of the excavator structural parts changes with the working time, and the "zero drift" phenomenon of the sensor and other factors, the high-precision positioning of the bucket tooth tip of the excavator is very difficult. At present, the excavator is calibrated before leaving a factory, or field calibration operation is carried out by professional maintenance personnel regularly, a large amount of manpower and time are consumed, and the excavator is quite inconvenient.
Disclosure of Invention
The present application is proposed to solve the above-mentioned technical problems. The embodiment of the application provides a method and a device for correcting arm support pose information and an excavator, and solves the technical problems.
According to one aspect of the application, a method for correcting the pose information of an arm support is provided, wherein the arm support comprises a plurality of sections of arm supports; the method for correcting the arm support pose information comprises the following steps: acquiring coordinate information of a free end of the cantilever crane in a preset state; the free end of the arm support is the end of the arm support far away from the fixed support end; measuring the angle information of the multi-section support arm of the arm frame in the preset state; wherein the angle information comprises pitch angles of the multi-section support arm; correcting parameters of a motion model of the arm support according to the coordinate information and the angle information; the motion model represents the corresponding relation between the coordinate information of the free end of the arm support and the angle information of the multi-section arm support.
In an embodiment, the obtaining of the coordinate information of the free end of the boom in the preset state includes: measuring a support arm included angle of an adjacent support arm in the multi-section support arms in the preset state; and calculating to obtain the coordinate information of the free end of the cantilever crane in the preset state according to the included angle of the supporting arm and the lengths of the multiple sections of the supporting arm.
In one embodiment, the preset states include a plurality; wherein the correcting the parameters of the motion model of the boom according to the coordinate information and the angle information comprises: and correcting parameters of the motion model according to the coordinate information and the angle information in the preset states.
In an embodiment, the correcting the parameters of the motion model according to the coordinate information and the angle information in the plurality of preset states includes: calculating to obtain a plurality of estimated coordinates in the preset state; the estimated coordinates are obtained through calculation according to the motion model; calculating the difference between the estimated coordinates in the preset states and the corresponding coordinate information; and correcting parameters of the motion model according to a plurality of the difference values.
In an embodiment, the correcting the parameters of the motion model according to the coordinate information and the angle information in the plurality of preset states includes: calculating to obtain a plurality of estimated angles in the preset state; the estimated angle is obtained by calculation according to the motion model; calculating the difference between the estimated angles in the preset states and the corresponding angle information; and correcting parameters of the motion model according to a plurality of the difference values.
In an embodiment, said correcting parameters of said motion model according to a plurality of said difference values comprises: and adjusting the parameter value of the motion model so that the sum of the difference values is smaller than a preset difference value.
In one embodiment, the preset state includes a plurality of states, and each preset state includes one or more of the following states: the included angle of the adjacent support arms in the multi-section support arms reaches a limit angle, the support arms are in a horizontal state, and the support arms are in a vertical state; the acquiring of the coordinate information of the free end of the arm support in the preset state comprises: acquiring the coordinate information of the free end of the arm support in a plurality of preset states; the measuring the angle information of the boom at the preset state of the multi-section support arm comprises: and measuring the angle information of the multi-section support arm under a plurality of preset states of the cantilever crane.
According to another aspect of the application, a device for correcting pose information of an arm support is provided, and the arm support is arranged on the arm support and comprises a plurality of sections of support arms; the correction device includes: the acquisition module is used for acquiring the coordinate information of the free end of the arm support in a preset state; the free end of the arm support is the end, far away from the fixed supporting end, of the arm support; the measuring module is used for measuring the angle information of the multi-section support arm of the arm frame in the preset state; wherein the angle information comprises a pitch angle of the multi-section support arm; the correction module is used for correcting parameters of a motion model of the arm support according to the coordinate information and the angle information; the motion model represents the corresponding relation between the coordinate information of the free end of the arm support and the angle information of the multi-section arm support.
According to another aspect of the present application, there is provided an excavator including: a body; the rotary platform is arranged on the machine body; the arm support is arranged on the rotary platform; and the device for correcting the arm support pose information.
In an embodiment, the calibration device includes a plurality of inertial sensors, and the plurality of inertial sensors are respectively disposed on the rotating platform, at a connection position of the boom and the rotating platform, and at a connection position of the adjacent boom.
According to the method and the device for correcting the arm support pose information and the excavator, the coordinate information of the free end of the arm support in the preset state of the arm support is obtained; and measuring the angle information of the arm frame in a plurality of sections under a preset state; the angle information comprises the pitching angles of the multi-section support arm; correcting parameters of a motion model of the arm support according to the coordinate information and the angle information; the motion model represents the corresponding relation between the coordinate information of the free end of the arm support and the angle information of the multi-section arm support; the method and the device have the advantages that the coordinate information of the free end of the arm support in a specific preset state and the angle information of the support arm are measured, so that the parameters of the motion model of the arm support are corrected according to the measured value in the preset state, the correction of the parameters of the motion model can be simply realized, the regular maintenance of professional maintainers is not needed, the labor cost and time are saved, the correction can be performed before operation to ensure the operation precision of the arm support, and the operation efficiency and precision are improved.
Drawings
The above and other objects, features and advantages of the present application will become more apparent by describing in more detail embodiments of the present application with reference to the attached drawings. The accompanying drawings are included to provide a further understanding of the embodiments of the application and are incorporated in and constitute a part of this specification, illustrate embodiments of the application and together with the description serve to explain the principles of the application. In the drawings, like reference numbers generally represent like parts or steps.
Fig. 1 is a schematic structural view of an excavator to which the present application is applied.
Fig. 2 is a schematic flowchart of a boom working method according to an exemplary embodiment of the present disclosure.
Fig. 3 is a schematic flow chart of a method for correcting boom pose information according to an exemplary embodiment of the present application.
Fig. 4 is a schematic structural diagram of a geometric topology of a boom according to an exemplary embodiment of the present application.
Fig. 5 is a schematic flow chart of a method for correcting boom pose information according to another exemplary embodiment of the present application.
Fig. 6 is a schematic flow chart of a method for correcting boom pose information according to another exemplary embodiment of the present application.
Fig. 7 is a schematic flow chart of a method for correcting boom pose information according to another exemplary embodiment of the present application.
Fig. 8 is a schematic structural diagram of a device for correcting boom pose information according to an exemplary embodiment of the present application.
Fig. 9 is a schematic structural diagram of a device for correcting boom pose information according to another exemplary embodiment of the present application.
Fig. 10 is a block diagram of an electronic device provided in an exemplary embodiment of the present application.
Detailed Description
Hereinafter, example embodiments according to the present application will be described in detail with reference to the accompanying drawings. It should be apparent that the described embodiments are only a few embodiments of the present application, and not all embodiments of the present application, and it should be understood that the present application is not limited to the example embodiments described herein.
Summary of the application
Along with the intelligent development of engineering machinery, more and more engineering machinery realizes automatic operation or semi-automatic operation, and the premise of the automatic operation and the semi-automatic operation is that the control precision meets the operation requirement. For example, in a back-hoe excavator or other construction machinery including a robot arm, the robot arm (boom) is generally formed by connecting a plurality of sections of arms such as a boom, an arm, and a bucket, and the bucket located at a free end of the boom can reach a designated operation site by adjusting an extension angle and a direction of the plurality of sections of arms, so that accurate operation is achieved.
The inertial sensor has high positioning accuracy and good economical efficiency, and can accurately acquire the position information of the multiple sections of support arms of the arm support by utilizing the inertial sensor, thereby determining the pose information of the arm support. However, after a long time of operation of the arm support, especially in a severe environment, the positioning accuracy of the bucket tooth tip is likely to be poor. For example, when digging hard ground for a long time, the multi-section support arm is stressed too much, so that the support arm is deformed or the angle between the adjacent support arms is changed; and the inertial sensor still has the zero drift phenomenon, and these factors can cause that the original motion model of the arm support can not reflect the current state well, so, need regularly to carry out the field correction to the arm support by professional maintainer, namely correct the motion model so that it can reflect the current state of the arm support, that is to say, the motion model after correcting can accurately calculate according to the data that inertial sensor gathered and obtain the tooth point position information of scraper bowl. However, such field maintenance not only needs to consume the time and energy of professional personnel to complete, for example, the maintenance personnel needs to perform multiple adjustments and detection, which itself has a certain probability that the maintenance personnel may perform the adjustments a few times or not to achieve the desired accuracy; but also by means of more precise instruments or professional sites, which is not simple, delays the correction for a long time, and causes a low frequency of correction (for efficiency and cost considerations), thereby affecting the working accuracy of the boom.
In order to solve the problems, the application provides a method for correcting the position and orientation information of the arm support, the coordinate information of the free end of the arm support and the angle information of the support arm in a specific preset state are acquired by using the existing inertial sensor on the arm support, so that the parameters of the motion model of the arm support are corrected according to the measured value in the preset state, the automatic correction of the arm support is realized, the correction of the arm support can be simply realized, the regular maintenance of professional maintenance personnel is not needed, the labor cost and time are saved, the correction can be carried out before the operation to ensure the operation precision of the arm support, and the efficiency and precision of each operation are improved.
Exemplary excavator
Fig. 1 is a schematic structural view of an excavator to which the present application is applied. As shown in fig. 1, the excavator includes: the device comprises a machine body 1, a rotary platform 2, an arm support 3 and a correction device for pose information of an upper arm support arranged on the arm support 3; the rotary platform 2 is arranged on the machine body 1, the arm support 3 is arranged on the rotary platform 2, and the arm support 3 comprises a movable arm 31, an arm 32 and a bucket 33. The direction of the arm support 3 is adjusted through the rotation of the rotary platform 2, and the arrival position of the free end (such as a bucket) of the arm support 3 is adjusted through adjusting the angle between each section of the arm support in the arm support 3, so that the precise operation is realized.
Specifically, the correcting device comprises a plurality of inertial sensors, and the plurality of inertial sensors are respectively arranged on the rotary platform 2, the joint of the arm support 3 and the rotary platform 2, and the joint of the adjacent support arms. The rotation angle of the rotary platform 2, the included angle between the arm support 3 and the rotary platform 2 and the included angle between adjacent support arms in a preset state are collected by a plurality of inertial sensors carried by a plurality of excavators, and the correction device of the arm support pose information adjusts parameters of the motion model according to the angle information in the preset state, so that the correction of the motion model is realized, namely the motion model of the arm support is automatically corrected by using the existing inertial sensors to ensure the operation precision of the arm support. The device for correcting the arm support pose information may include a controller or a control chip disposed on the arm support 3, or a control chip or a control module integrated in a controller of the excavator, and may automatically (e.g., periodically) or automatically correct the motion model of the arm support according to a user instruction.
Exemplary method
Fig. 2 is a schematic flow chart of an arm support working method according to an exemplary embodiment of the present application. As shown in fig. 2, in the normal operation mode, the inertial sensor observes data, that is, the inertial sensor observes in real time to acquire direction and angle information of the boom, and inputs the observed data into the motion model to obtain pose information of the boom, so as to provide the pose information of the boom for the boom operation, so as to provide automation control; in the correction mode, the inertial sensor observes observation data in a preset pose, and the observation data is input into the parameter identification correction model to correct parameters of the motion model, so that a more accurate motion model is obtained. The observation data obtained by the inertial sensor is joint space data, that is, relative data such as the length and the mutual included angle of each support arm of the arm support, and the motion model calculates the working space data (that is, coordinate data in a space coordinate system) according to the joint space data.
Fig. 3 is a schematic flow chart of a method for correcting boom pose information according to an exemplary embodiment of the present application. The arm support comprises a plurality of sections of support arms; as shown in fig. 3, the method for correcting the pose information of the boom comprises the following steps:
step 310: and acquiring coordinate information of the free end of the arm support in a preset state.
Wherein, the free end of the arm support is the end of the arm support (such as the bucket) far away from the fixed support end. In one embodiment, the preset state may include a plurality of states, each preset state including one or more of the following: the support arm included angle of adjacent support arms in the multi-section support arms reaches a limit angle, the support arms are in a horizontal state, and the support arms are in a vertical state; the specific implementation manner of step 310 may be: and acquiring coordinate information of the free end of the arm support under a plurality of preset states.
Specifically, for convenience of description, as shown in fig. 4, the pose information of the boom is decomposed into two state spaces: joint space and working space. In a plane coordinate system Y 0 OZ 0 In the working space using [ y, z, psi ]] T Specifically, the coordinate system includes the Y-axis and Z-axis coordinates of the bucket tooth tip in the base coordinate system, and the angle ψ between the line connecting the bucket tooth tip and the bucket hinge point and the horizontal plane (i.e., the vector a in FIG. 4) 4 Angle to the horizontal). Joint space available [ theta ] 234 ] T Indicating, in particular, the relative angle of rotation theta of the boom about the swing platform 2 Relative rotation angle theta between arm and boom 3 Relative rotation angle theta between bucket and stick 4
Step 320: and measuring the angle information of the multi-section support arm of the arm frame in a preset state.
Wherein the angle information comprises the pitch angle of the multi-section support arm. In an embodiment, the specific implementation manner of step 220 may be: and measuring the angle information of the multi-section support arm of the arm frame under a plurality of preset states. Specifically, the absolute pitch angle delta of the upper vehicle (rotary platform) to the ground is measured by using an inertial sensor 1 Absolute pitch angle delta of moving arm to ground 2 Absolute pitching angle delta of bucket rod to ground 3 Absolute pitch angle delta of bucket to ground 4 . Is ideally ofIn case of θ 2 =δ 21 ,θ 3 =δ 32 ,θ 4 =δ 43 However, in practice, the joint angle calculated according to the above formula fluctuates to a large extent, i.e., there is a large systematic error.
Step 330: and correcting parameters of the motion model of the arm support according to the coordinate information and the angle information.
The motion model represents the corresponding relation between the coordinate information of the free end of the arm support and the angle information of the multi-section arm support. In an embodiment, the specific implementation manner of step 330 may be: and correcting parameters of the motion model according to the coordinate information and the angle information in a plurality of preset states. And according to the coordinate information and the angle information under a plurality of special states (namely preset states), performing parameter correction on the motion model to obtain the motion model according with the current state of the arm support, so that the operation precision of the arm support is improved.
The motion model established by the application is shown as a formula (1), and the corresponding parameters are shown as a formula (2):
Figure BDA0003667191380000081
Figure BDA0003667191380000082
wherein,
Figure BDA0003667191380000083
the predicted value of the ground pitch angle of the rotary platform in the maximum joint angle state is obtained,
Figure BDA0003667191380000084
the predicted value of the ground pitch angle of the movable arm in the state of the maximum joint angle is obtained,
Figure BDA0003667191380000085
for the pair of the rotary platform in the state of the minimum joint angleThe predicted value of the pitch angle of the ground,
Figure BDA0003667191380000091
the predicted value of the ground pitch angle of the movable arm in the state of the maximum joint angle is obtained,
Figure BDA0003667191380000092
for the predicted value of the ground pitch angle of the rotary platform in the horizontal state,
Figure BDA0003667191380000093
the predicted value of the ground pitch angle of the movable arm in the horizontal state,
Figure BDA0003667191380000094
the predicted value of the ground pitch angle of the bucket rod in the state of the maximum joint angle,
Figure BDA0003667191380000095
the predicted value of the ground pitch angle of the bucket rod in the state of the minimum joint angle,
Figure BDA0003667191380000096
the predicted value of the ground pitch angle of the movable arm in the vertical state is obtained,
Figure BDA0003667191380000097
the predicted value of the ground pitch angle of the bucket rod in the vertical state,
Figure BDA0003667191380000098
the predicted value of the ground pitch angle of the bucket in the state of the maximum joint angle,
Figure BDA0003667191380000099
the predicted value of the ground pitch angle of the bucket in the state of the minimum joint angle,
Figure BDA00036671913800000910
the predicted value of the ground pitch angle of the bucket rod in the horizontal state,
Figure BDA00036671913800000911
the predicted value of the ground pitch angle of the bucket in the horizontal state,
Figure BDA00036671913800000912
for the predicted value of the ground pitch angle of the bucket in the vertical state,
Figure BDA00036671913800000913
the predicted value of the relative rotation angle of the movable arm around the rotary platform under the state of the maximum joint angle is obtained,
Figure BDA00036671913800000914
the predicted value of the relative rotation angle of the boom around the swing platform in the horizontal state is the predicted value,
Figure BDA00036671913800000915
the predicted value of the relative rotation angle of the movable arm around the rotary platform under the state of the minimum joint angle is obtained,
Figure BDA00036671913800000916
the predicted value of the relative rotation angle between the arm and the movable arm under the state that the arm is at the maximum joint angle is obtained,
Figure BDA00036671913800000917
the predicted value of the relative rotation angle between the arm and the movable arm under the state that the arm is at the minimum joint angle is obtained,
Figure BDA00036671913800000918
is a predicted value of a relative rotation angle between the arm and the boom in a vertical state of the arm,
Figure BDA00036671913800000919
the predicted value of the relative rotation angle between the bucket and the bucket rod in the state of the maximum joint angle of the bucket,
Figure BDA00036671913800000920
is at a minimum for the bucketA predicted value of a relative rotation angle between the bucket and the arm in the joint angle state,
Figure BDA00036671913800000921
is a predicted value of the relative rotation angle between the bucket and the arm in the vertical state of the bucket,
Figure BDA00036671913800000922
is a predicted value of the relative rotation angle between the bucket and the stick in the horizontal state of the bucket. In a normal mode, the position and attitude information of the arm support can be output by inputting the data observed by the inertial sensor into the formula (1).
According to the method for correcting the position and posture information of the arm support, the coordinate information of the free end of the arm support in a preset state is obtained; and measuring the angle information of the arm frame in a plurality of sections under a preset state; the angle information comprises the pitching angles of the multi-section support arm; correcting parameters of a motion model of the arm support according to the coordinate information and the angle information; the motion model represents the corresponding relation between the coordinate information of the free end of the arm support and the angle information of the multi-section arm support; the method and the device have the advantages that the coordinate information of the free end of the arm support in a specific preset state and the angle information of the support arm are measured, so that the parameters of the motion model of the arm support are corrected according to the measured value in the preset state, the correction of the parameters of the motion model can be simply realized, the regular maintenance of professional maintainers is not needed, the labor cost and time are saved, the correction can be performed before operation to ensure the operation precision of the arm support, and the operation efficiency and precision are improved.
Fig. 5 is a schematic flow chart of a method for correcting boom pose information according to another exemplary embodiment of the present application. As shown in fig. 5, the step 310 may include:
step 311: and measuring the support arm included angle of the adjacent support arm in the multi-section support arms in a preset state.
In general, the length of the arm support and the arm included angle (included angle range) of the adjacent arm support have small changes, and the posture information of the arm support can be objectively reflected.
Step 312: and calculating to obtain the coordinate information of the free end of the arm support in a preset state according to the included angle of the support arm and the lengths of the multiple sections of support arms.
The coordinate information of the free end of the arm support can be obtained through calculation by measuring the arm support included angle of the adjacent arm support in the multiple sections of arm supports in the preset state. Specifically, in the topology shown in fig. 4, the following geometric relationship can be obtained:
y=ACcosθ 2 +CQcosθ 3 +QNcosθ 4 (3)
Z=ACsinθ 2 +CQsinθ 3 +QNsinθ 4 (4)
ψ=θ 234 (5)
wherein AC corresponds to the vector a 2 Of (a) modulo length, CQ corresponding to vector a 3 Modulo length of (c), QN corresponding to vector a 4 Die length of (2).
Equations (3) - (5) can be represented in a matrix as:
Figure BDA0003667191380000111
fig. 6 is a schematic flow chart of a method for correcting boom pose information according to another exemplary embodiment of the present application. As shown in fig. 6, the step 330 may include:
step 331: and calculating to obtain estimated angles in a plurality of preset states.
And calculating the estimated angle according to the motion model. Specifically, a conversion relationship between a special attitude (preset state) and observation data of the inertial sensor can be established according to a corresponding relationship between a joint space and a working space:
Figure BDA0003667191380000112
equation (7) can be formally simplified as:
Ξ 10*1 =K 10*15 Θ 15*1 (8)
the 36 special poses of the arm support are obtained according to the combination of various special positions of a movable arm (comprising a maximum angle, a minimum angle and a horizontal position), a bucket rod (comprising a maximum angle, a minimum angle and a vertical position) and a bucket (comprising a maximum angle, a minimum angle, a horizontal position and a vertical position) (not all listed in the following table 1):
table 1 special pose summary table of arm support
Sequence of Pose position Attitude of the boom Attitude of bucket rod Bucket attitude
1 (x 1 ,y 11 ) θ 2max θ 3max θ 4max
2 (x 2 ,y 22 ) θ 2max θ 3max θ 4min
3 (x 3 ,y 33 ) θ 2max θ 3max θ 4h
4 (x 4 ,y 44 ) θ 2max θ 3max θ 4v
In a matrix form, the 36 poses are uniformly expressed as:
Figure BDA0003667191380000121
the form of equation (9) can be simplified as:
Ψ 36*3 =H 36*9 *M 9*3 (10)
among them, the 36 sets of special pose matrix Ψ and the structural matrix M of the working device vary little after shipment and are relatively easy to measure, and can be considered as known quantities. Matrix H is formed by xi 10*1 Obtained by the operator Λ (·), i.e.:
H 36*9 =Λ(Ξ 10*1 ) (11)
by combining the formulas (7) to (11), the relation between the special pose of the arm support and the reading of the inertial sensor can be obtained as follows:
Ψ 36*3 =Λ(K 10*15 Θ 15*1 )M 9*3 (12)
the parameter estimation value can be calculated according to the formula (12)
Figure BDA0003667191380000131
And xi is:
Figure BDA0003667191380000132
Ξ 10*1 =Λ -1 [ΨM T (MM T ) -1 ] (14)
step 332: and calculating the difference between the estimated angles in the plurality of preset states and the corresponding angle information.
After the estimated angle is calculated according to the actually measured coordinate information, the error value of the motion model in each special pose state is reflected by comparing the difference between the estimated angle in each special pose state and the corresponding angle information.
Step 333: and correcting the parameters of the motion model according to the plurality of difference values.
And correcting the parameters of the motion model according to the error values of the motion model in all special pose states so as to enable the error values of the motion model to be smaller. I.e. using parameter estimates
Figure BDA0003667191380000133
And xi updating the parameters of the motion model f in the kinematic model (1), namely obtaining the kinematic model which is more in line with the current state of the arm support and the sensor, such as a least square method.
Fig. 7 is a schematic flow chart of a method for correcting boom pose information according to another exemplary embodiment of the present application. As shown in fig. 7, the step 330 may include:
step 334: and calculating to obtain estimated coordinates in a plurality of preset states.
And calculating the estimated coordinates according to the motion model. The specific calculation method can be obtained as the above equation (12).
Step 335: and calculating the difference between the estimated coordinates in a plurality of preset states and the corresponding coordinate information.
After the estimated coordinates are calculated according to the actually measured angle information, the error value of the motion model in each special pose state is reflected by comparing the difference value between the estimated coordinates in each special pose state and the corresponding coordinate information.
Step 336: and correcting the parameters of the motion model according to the plurality of difference values.
And correcting parameters of the motion model according to the error values of the motion model in all special pose states so as to enable the error values of the motion model to be smaller.
In an embodiment, the specific implementation manner of step 333 and step 336 may be: and adjusting the parameter value of the motion model so that the sum of the difference values is smaller than the preset difference value.
Because the parameter of the motion model is modified to affect the size of the difference, the parameter value of the motion model is iteratively adjusted, and the difference and the corresponding loss value (such as the sum of the differences) in a plurality of special pose states are calculated again according to the adjusted parameter value, and when the loss value is smaller than the preset value, the parameter value of the motion model is more appropriate. That is, the parameters of the motion model are corrected according to the difference values, so that the sum of all the difference values (for example, the sum of the squares of the difference values) is small (for example, smaller than a preset value), or the difference values are all small (for example, the maximum value of the difference values is smaller than a preset value) to ensure that the error value of the motion model in the normal operating state is not too large.
In order to improve the accuracy of the model, the 36 groups of special poses can be circularly debugged and observed for 3-5 times in actual operation, so that the stability and the convergence of parameter identification are improved.
Exemplary devices
Fig. 8 is a schematic structural diagram of a device for correcting boom pose information according to an exemplary embodiment of the present application. The device for correcting the pose information of the arm support is arranged on the arm support, and the arm support comprises a plurality of sections of support arms; as shown in fig. 8, the device 80 for correcting the boom pose information includes: the acquiring module 81 is used for acquiring coordinate information of a free end of the arm support in a preset state; the free end of the arm support is the end of the arm support far away from the fixed support end; the measuring module 82 is used for measuring the angle information of the arm frame in a plurality of sections under a preset state; the angle information comprises the pitching angles of the multi-section support arm; the correction module 83 is used for correcting the parameters of the motion model of the arm support according to the coordinate information and the angle information; the motion model represents the corresponding relation between the coordinate information of the free end of the arm support and the angle information of the multi-section arm support.
According to the device for correcting the arm support pose information, the coordinate information of the free end of the arm support in the preset state of the arm support is obtained through the obtaining module 81; the measuring module 82 measures the angle information of the arm support in a plurality of sections under a preset state; the angle information comprises the pitching angles of the multi-section support arm; the correction module 83 corrects the parameters of the motion model of the arm support according to the coordinate information and the angle information; the motion model represents the corresponding relation between the coordinate information of the free end of the arm support and the angle information of the multi-section arm support; the method and the device have the advantages that the coordinate information of the free end of the arm support in a specific preset state and the angle information of the support arm are measured, so that the parameters of the motion model of the arm support are corrected according to the measured value in the preset state, the correction of the parameters of the motion model can be simply realized, the regular maintenance of professional maintenance personnel is not needed, the labor cost and time are saved, the correction can be carried out before operation to ensure the operation precision of the arm support, and the operation efficiency and precision are improved.
In one embodiment, the preset state may include a plurality of states, each preset state including one or more of the following combinations of states: the included angle of the adjacent support arms in the multi-section support arms reaches a limit angle, the support arms are in a horizontal state, and the support arms are in a vertical state; wherein, the obtaining module 81 may be further configured to: and acquiring coordinate information of the free end of the arm support under a plurality of preset states.
In an embodiment, the measurement module 82 may be further configured to: and measuring the angle information of the multi-section support arm of the arm frame under a plurality of preset states.
In an embodiment, the correction module 83 may be further configured to: and correcting parameters of the motion model according to the coordinate information and the angle information in a plurality of preset states.
Fig. 9 is a schematic structural diagram of a device for correcting boom pose information according to another exemplary embodiment of the present application. As shown in fig. 9, the obtaining module 81 may include: an included angle measuring unit 811 for measuring a support arm included angle of an adjacent support arm in the multi-section support arm in a preset state; and a coordinate calculation unit 812, configured to calculate, according to the included angle of the support arm and the lengths of the multiple sections of support arms, to obtain coordinate information of the free end of the boom in the preset state.
In an embodiment, as shown in fig. 9, the calibration module 83 may include: the estimation unit 831 is configured to calculate estimated angles in a plurality of preset states; a difference calculating unit 832, configured to calculate differences between the estimated angles in the multiple preset states and the corresponding angle information; a parameter correcting unit 833, configured to correct a parameter of the motion model according to the multiple differences.
In an embodiment, the estimation unit 831 may be configured to: calculating to obtain estimated coordinates under a plurality of preset states; the difference calculation unit 832 may be configured to: calculating the difference between the estimated coordinates in a plurality of preset states and the corresponding coordinate information; the parameter correcting unit 833 may be configured to: and correcting the parameters of the motion model according to the plurality of difference values.
In an embodiment, the parameter correcting unit 833 may be further configured to: and adjusting the parameter value of the motion model so that the sum of the difference values is smaller than the preset difference value.
Exemplary electronic device
Next, an electronic apparatus according to an embodiment of the present application is described with reference to fig. 10. The electronic device may be either or both of the first device and the second device, or a stand-alone device separate from them, which stand-alone device may communicate with the first device and the second device to receive the acquired input signals therefrom.
FIG. 10 illustrates a block diagram of an electronic device in accordance with an embodiment of the present application.
As shown in fig. 10, the electronic device 10 includes one or more processors 11 and memory 12.
The processor 11 may be a Central Processing Unit (CPU) or other form of processing unit having data processing capabilities and/or instruction execution capabilities, and may control other components in the electronic device 10 to perform desired functions.
Memory 12 may include one or more computer program products that may include various forms of computer-readable storage media, such as volatile memory and/or non-volatile memory. The volatile memory may include, for example, Random Access Memory (RAM), cache memory (cache), and/or the like. The non-volatile memory may include, for example, Read Only Memory (ROM), hard disk, flash memory, etc. One or more computer program instructions may be stored on the computer-readable storage medium, and the processor 11 may execute the program instructions to implement the method for correcting boom pose information of the various embodiments of the present application described above and/or other desired functions. Various contents such as an input signal, a signal component, a noise component, etc. may also be stored in the computer-readable storage medium.
In one example, the electronic device 10 may further include: an input device 13 and an output device 14, which are interconnected by a bus system and/or other form of connection mechanism (not shown).
When the electronic device is a stand-alone device, the input means 13 may be a communication network connector for receiving the acquired input signals from the first device and the second device.
The input device 13 may also include, for example, a keyboard, a mouse, and the like.
The output device 14 may output various information including the determined distance information, direction information, and the like to the outside. The output devices 14 may include, for example, a display, speakers, a printer, and a communication network and its connected remote output devices, among others.
Of course, for simplicity, only some of the components of the electronic device 10 relevant to the present application are shown in fig. 10, and components such as buses, input/output interfaces, and the like are omitted. In addition, the electronic device 10 may include any other suitable components depending on the particular application.
The computer program product may be written with program code for performing the operations of embodiments of the present application in any combination of one or more programming languages, including an object oriented programming language such as Java, C + + or the like and conventional procedural programming languages, such as the "C" programming language or similar programming languages. The program code may execute entirely on the user's computing device, partly on the user's device, as a stand-alone software package, partly on the user's computing device and partly on a remote computing device, or entirely on the remote computing device or server.
The computer-readable storage medium may take any combination of one or more readable media. The readable medium may be a readable signal medium or a readable storage medium. A readable storage medium may include, for example, but not limited to, an electronic, magnetic, optical, electromagnetic, infrared, or semiconductor system, apparatus, or device, or a combination of any of the foregoing. More specific examples (a non-exhaustive list) of the readable storage medium include: an electrical connection having one or more wires, a portable disk, a hard disk, a Random Access Memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disc read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the foregoing.
The foregoing description has been presented for purposes of illustration and description. Furthermore, the description is not intended to limit embodiments of the application to the form disclosed herein. While a number of example aspects and embodiments have been discussed above, those of skill in the art will recognize certain variations, modifications, alterations, additions and sub-combinations thereof.

Claims (10)

1. A method for correcting the pose information of an arm support comprises the steps that the arm support comprises a plurality of sections of support arms; the method for correcting the arm support pose information is characterized by comprising the following steps:
acquiring coordinate information of a free end of the cantilever crane in a preset state; the free end of the arm support is the end of the arm support far away from the fixed support end;
measuring the angle information of the multi-section support arm of the arm frame in the preset state; wherein the angle information comprises a pitch angle of the multi-section support arm; and
correcting parameters of a motion model of the arm support according to the coordinate information and the angle information; the motion model represents the corresponding relation between the coordinate information of the free end of the arm support and the angle information of the multi-section arm support.
2. The method for correcting the pose information of the boom according to claim 1, wherein the acquiring the coordinate information of the free end of the boom in a preset state comprises:
measuring a support arm included angle of an adjacent support arm in the multi-section support arms in the preset state; and
and calculating to obtain the coordinate information of the free end of the cantilever crane in the preset state according to the included angle of the supporting arm and the lengths of the multiple sections of the supporting arm.
3. The method for correcting the boom pose information according to claim 1, wherein the preset state comprises a plurality of states; wherein the correcting the parameters of the motion model of the arm support according to the coordinate information and the angle information comprises:
and correcting parameters of the motion model according to the coordinate information and the angle information in the preset states.
4. The method for correcting the boom pose information according to claim 3, wherein the correcting the parameters of the motion model according to the coordinate information and the angle information in the plurality of preset states comprises:
calculating to obtain a plurality of estimated coordinates in the preset state; the estimated coordinates are obtained through calculation according to the motion model;
calculating the difference between the estimated coordinates in the preset states and the corresponding coordinate information; and
and correcting the parameters of the motion model according to a plurality of difference values.
5. The method for correcting the boom pose information according to claim 3, wherein the correcting the parameters of the motion model according to the coordinate information and the angle information in the plurality of preset states comprises:
calculating to obtain a plurality of estimated angles in the preset state; the estimated angle is obtained by calculation according to the motion model;
calculating the difference between the estimated angles in the preset states and the corresponding angle information; and
and correcting the parameters of the motion model according to a plurality of difference values.
6. The method for correcting the boom pose information according to claim 4 or 5, wherein the correcting the parameters of the motion model according to the plurality of difference values comprises:
and adjusting the parameter value of the motion model so that the sum of the difference values is smaller than a preset difference value.
7. The method for correcting the boom pose information according to any one of claims 1 to 5, wherein the preset state comprises a plurality of states, and each preset state comprises one or more of the following states: the included angle of the adjacent support arms in the multi-section support arms reaches a limit angle, the support arms are in a horizontal state, and the support arms are in a vertical state;
the acquiring of the coordinate information of the free end of the arm support in the preset state comprises:
acquiring the coordinate information of the free end of the arm support in a plurality of preset states;
the measuring the angle information of the boom at the preset state of the multi-section support arm comprises:
and measuring the angle information of the multi-section support arm in a plurality of preset states of the arm frame.
8. A device for correcting pose information of an arm support is arranged on the arm support, and the arm support comprises a plurality of sections of support arms; characterized in that said correction means comprise:
the acquisition module is used for acquiring the coordinate information of the free end of the arm support in a preset state; the free end of the arm support is the end of the arm support far away from the fixed support end;
the measuring module is used for measuring the angle information of the arm frame on the multiple sections of support arms in the preset state; wherein the angle information comprises pitch angles of the multi-section support arm; and
the correction module is used for correcting parameters of a motion model of the arm support according to the coordinate information and the angle information; the motion model represents the corresponding relation between the coordinate information of the free end of the arm support and the angle information of the multi-section arm support.
9. An excavator, comprising:
a body;
the rotary platform is arranged on the machine body;
the arm support is arranged on the rotary platform; and
the boom pose information correcting device of claim 8.
10. The excavator of claim 9 wherein the calibration device comprises a plurality of inertial sensors disposed on the swing platform, at the junction of the boom and the swing platform, and at the junction of adjacent arms, respectively.
CN202210590698.1A 2022-05-27 2022-05-27 Boom pose information correction method and device and excavator Active CN115030247B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210590698.1A CN115030247B (en) 2022-05-27 2022-05-27 Boom pose information correction method and device and excavator

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210590698.1A CN115030247B (en) 2022-05-27 2022-05-27 Boom pose information correction method and device and excavator

Publications (2)

Publication Number Publication Date
CN115030247A true CN115030247A (en) 2022-09-09
CN115030247B CN115030247B (en) 2023-10-31

Family

ID=83121781

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210590698.1A Active CN115030247B (en) 2022-05-27 2022-05-27 Boom pose information correction method and device and excavator

Country Status (1)

Country Link
CN (1) CN115030247B (en)

Citations (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1651666A (en) * 2005-03-28 2005-08-10 广西柳工机械股份有限公司 Path control system used for hydraulic digger operating device and its method
JP2012233353A (en) * 2011-05-02 2012-11-29 Komatsu Ltd Calibration system for hydraulic shovel and calibration method for the hydraulic shovel
CN103080427A (en) * 2011-03-24 2013-05-01 株式会社小松制作所 Hydraulic shovel calibration device and hydraulic shovel calibration method
WO2015173920A1 (en) * 2014-05-14 2015-11-19 株式会社小松製作所 Hydraulic shovel calibration system and calibration method
CN107614803A (en) * 2015-10-28 2018-01-19 株式会社小松制作所 The bearing calibration of the means for correcting of Work machine, Work machine and Work machine
CN109296019A (en) * 2018-11-08 2019-02-01 北京拓疆者智能科技有限公司 Digger arm motion control method, system and device
CN109440854A (en) * 2018-10-18 2019-03-08 南京天辰礼达电子科技有限公司 A method of calculating bucket point and large arm shaft core position relationship
US20190078302A1 (en) * 2017-07-13 2019-03-14 Komatsu Ltd. Hydraulic excavator and hydraulic excavator calibration method
CN109605372A (en) * 2018-12-20 2019-04-12 中国铁建重工集团有限公司 A kind of method and system of the pose for survey engineering mechanical arm
CN109642409A (en) * 2016-11-21 2019-04-16 日立建机株式会社 Engineering machinery
CN109732590A (en) * 2018-12-20 2019-05-10 中国铁建重工集团有限公司 A kind of online calibration method of engineering machinery arm
CN110392754A (en) * 2017-03-17 2019-10-29 日立建机株式会社 Engineering machinery
CN110725359A (en) * 2019-10-28 2020-01-24 上海三一重机股份有限公司 Trajectory control method and excavator
CN112095710A (en) * 2020-09-16 2020-12-18 上海三一重机股份有限公司 Excavator pose display method and device and excavator applying same
JPWO2021192969A1 (en) * 2020-03-26 2021-09-30
CN113684886A (en) * 2021-09-30 2021-11-23 广西柳工机械股份有限公司 Method for acquiring position parameter data of working device and loader
CN114045893A (en) * 2021-10-25 2022-02-15 上海华兴数字科技有限公司 Excavator bucket tooth point positioning method and device and excavator

Patent Citations (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1651666A (en) * 2005-03-28 2005-08-10 广西柳工机械股份有限公司 Path control system used for hydraulic digger operating device and its method
CN103080427A (en) * 2011-03-24 2013-05-01 株式会社小松制作所 Hydraulic shovel calibration device and hydraulic shovel calibration method
US20130158789A1 (en) * 2011-03-24 2013-06-20 Masanobu Seki Hydraulic shovel calibration device and hydraulic shovel calibration method
JP2012233353A (en) * 2011-05-02 2012-11-29 Komatsu Ltd Calibration system for hydraulic shovel and calibration method for the hydraulic shovel
WO2015173920A1 (en) * 2014-05-14 2015-11-19 株式会社小松製作所 Hydraulic shovel calibration system and calibration method
CN107614803A (en) * 2015-10-28 2018-01-19 株式会社小松制作所 The bearing calibration of the means for correcting of Work machine, Work machine and Work machine
US20180171598A1 (en) * 2015-10-28 2018-06-21 Komatsu Ltd. Calibration device of work machine, work machine, and calibration method of work machine
CN109642409A (en) * 2016-11-21 2019-04-16 日立建机株式会社 Engineering machinery
CN110392754A (en) * 2017-03-17 2019-10-29 日立建机株式会社 Engineering machinery
CN109496245A (en) * 2017-07-13 2019-03-19 株式会社小松制作所 The bearing calibration of hydraulic crawler excavator and hydraulic crawler excavator
US20190078302A1 (en) * 2017-07-13 2019-03-14 Komatsu Ltd. Hydraulic excavator and hydraulic excavator calibration method
CN109440854A (en) * 2018-10-18 2019-03-08 南京天辰礼达电子科技有限公司 A method of calculating bucket point and large arm shaft core position relationship
CN109296019A (en) * 2018-11-08 2019-02-01 北京拓疆者智能科技有限公司 Digger arm motion control method, system and device
CN109605372A (en) * 2018-12-20 2019-04-12 中国铁建重工集团有限公司 A kind of method and system of the pose for survey engineering mechanical arm
CN109732590A (en) * 2018-12-20 2019-05-10 中国铁建重工集团有限公司 A kind of online calibration method of engineering machinery arm
CN110725359A (en) * 2019-10-28 2020-01-24 上海三一重机股份有限公司 Trajectory control method and excavator
JPWO2021192969A1 (en) * 2020-03-26 2021-09-30
CN112095710A (en) * 2020-09-16 2020-12-18 上海三一重机股份有限公司 Excavator pose display method and device and excavator applying same
CN113684886A (en) * 2021-09-30 2021-11-23 广西柳工机械股份有限公司 Method for acquiring position parameter data of working device and loader
CN114045893A (en) * 2021-10-25 2022-02-15 上海华兴数字科技有限公司 Excavator bucket tooth point positioning method and device and excavator

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
王太海;陈建宏;金俊;: "基于挖掘机GNSS精确定位的开采姿态监测系统", 黄金科学技术, no. 04 *
胡海浪;殷晨波;周俊静;贾文华;: "液压挖掘机轨迹规划及运动仿真", 机械制造与自动化, no. 02 *
马治宁;徐格宁;侯鹏龙;: "液压挖掘机工作装置作业空间研究", 起重运输机械, no. 09 *

Also Published As

Publication number Publication date
CN115030247B (en) 2023-10-31

Similar Documents

Publication Publication Date Title
CN107042528B (en) Kinematics calibration system and method for industrial robot
CN110815206B (en) Kinematics calibration method for Stewart parallel robot
CN104390612B (en) Six-degree-of-freedom parallel robot benchmark pose scaling method for Stewart platform configuration
TWI424164B (en) Differential calibration
US5138563A (en) Method and apparatus to correct for gravitational sag in the articulated mounting of a probe in a coordinate-measuring machine
CN107421442A (en) A kind of robot localization error online compensation method of externally measured auxiliary
US20070198212A1 (en) Form measuring instrument, form measuring method and form measuring program
CN110757504A (en) Positioning error compensation method of high-precision movable robot
CN109764805A (en) A kind of mechanical arm positioning device and method based on laser scanning
CN105334802B (en) It is a kind of to adjust main shaft and the method for C axis concentricities
CN114045893A (en) Excavator bucket tooth point positioning method and device and excavator
CN111716331A (en) A device and method for calibrating parameters of a six-degree-of-freedom parallel mechanism
CN113618738A (en) Mechanical arm kinematic parameter calibration method and system
JP5378908B2 (en) Robot accuracy adjustment method and robot
CN106671081B (en) A kind of lower-mobility robot kinematics calibration method based on monocular vision
CN115030247B (en) Boom pose information correction method and device and excavator
CN114485582B (en) Method for calibrating angles and distances of key points of excavator based on total station measurement
CN115840217A (en) Method and system for calibrating parameters of bucket wheel stacker-reclaimer airborne lidar
JP2002181539A (en) Position detection method and device using GPS in civil engineering construction machine
CN114800621B (en) Zero calibration system and method for mechanical arm angle sensor and full-computer trolley
CN110398222B (en) Leveling angle and erecting angle measuring method, device and system
CN113503856A (en) Tunnel trolley positioning measurement method and system
CN115674171A (en) Robot pose measurement and compensation method and system, control device, storage medium
CN108107882A (en) Service robot automatic Calibration and detecting system based on optical motion tracking
CN113532352B (en) A method for detecting the position of a six-degree-of-freedom displacement platform

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