A method and device for remote operation control of an excavator

By acquiring the joint angles and equipment profile parameter packages of the master miniature excavator, the problem of adapting the teleoperation system to different excavators was solved, thereby improving the intuitiveness and safety of operation.

CN123109243APending Publication Date: 2026-11-17JOULE STEP (BEIJING) INTELLIGENT TECHNOLOGY CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202611482464.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2026-09-22
Publication Date
2026-11-17

AI Technical Summary

Technical Problem

Existing master-slave isomorphic teleoperation technology lacks a universal adaptation mechanism and cannot be compatible with various types of excavating equipment with different structural parameters, feedback forms and control interfaces, resulting in limited intuitiveness and safety for operators in high-risk environments.

Method used

By acquiring the original joint angles of the operating mechanism of the master miniature excavator, and using the equipment identifier of the target slave excavator to obtain the pre-calibrated equipment profile parameter package, control commands are generated based on the joint angle mapping function and control mode, thereby achieving adaptation to different mechanical sizes, feedback forms and control interfaces.

Benefits of technology

This technology enables the same master-end miniature excavator to be adapted to different slave-end excavators, reducing the cognitive load on operators and improving operational intuitiveness and safety.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN123109243A_ABST
    Figure CN123109243A_ABST
Patent Text Reader

Abstract

This application discloses a remote operation control method and device for excavators, relating to the field of remote operation control of construction machinery. The method includes: acquiring the original joint angles of the operating mechanism of the master miniature excavator in real time; obtaining a device profile parameter package corresponding to the target slave excavator based on the device identifier of the target slave excavator; converting the original joint angles into target joint angles according to the joint angle mapping function corresponding to the target slave excavator; generating a first control command executable by the target slave excavator based on the target joint angles according to the control mode of the target slave excavator, and sending it to the target slave excavator to control the target slave excavator to perform actions corresponding to the posture of the operating mechanism of the master miniature excavator. This application, while retaining the intuitiveness of master-slave isomorphic operation, implements a universal adaptation mechanism, enabling the same master miniature excavator to adapt to target slave excavators with different mechanical dimensions, feedback forms, and control interfaces.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This application relates to the field of remote operation technology for construction machinery, and in particular to a remote operation control method and device for excavators. Background Technology

[0002] With the rapid development of construction machinery towards intelligence and unmanned operation, excavators are increasingly expanding into high-risk, unstructured environments such as earthquake relief, mining, and contaminated area cleanup. Traditional manual operation poses significant safety hazards, making remote control technology a crucial development direction in excavator control. The remote control system plays a vital role in transmitting operator intentions across space and driving heavy equipment to precisely complete tasks. Its intuitive operation, equipment adaptability, and operational safety are key performance indicators for remote control systems.

[0003] In current technology, in order to improve the intuitiveness of operation, master-slave isomorphic teleoperation technology is gradually being applied. This type of technology makes the master-end miniature robotic arm consistent with the slave-end excavator working device in terms of kinematic topology, degree of freedom configuration and joint connection sequence. The operator forms corresponding posture input by swinging each joint of the master end, which is more conducive to intuitively conveying the control intention of the slave end posture and end trajectory compared with traditional handle control.

[0004] However, the current master-slave isomorphic teleoperation method is developed for specific models and lacks a universal adaptation mechanism, making it incompatible with various types of excavating equipment with different structural parameters, feedback forms and control interfaces. Summary of the Invention

[0005] Based on the above problems, this application provides a remote operation control method and device for excavators. While retaining the intuitiveness of master-slave isomorphic operation, it realizes a universal adaptation mechanism, enabling the same master-end miniature excavator to adapt to target slave excavators with different mechanical dimensions, feedback forms and control interfaces.

[0006] The embodiments of this application disclose the following technical solutions: In a first aspect, embodiments of this application provide a remote operation control method for an excavator, applied to a master-end miniature excavator, the method comprising: The original joint angles of the operating mechanism of the main-end miniature excavator are acquired in real time. Based on the device identifier of the target slave excavator connected to the master miniature excavator, a pre-calibrated device profile parameter package corresponding to the target slave excavator is obtained; wherein, the device profile parameters include at least: joint angle mapping function and control mode of the target slave excavator; Based on the joint angle mapping function corresponding to the target excavator, the original joint angle is converted into the target joint angle; Based on the control mode of the target slave excavator and the target joint angle, a first control command executable by the target slave excavator is generated and sent to the target slave excavator to control the target slave excavator to perform actions corresponding to the operating mechanism posture of the master miniature excavator.

[0007] In one possible implementation, the control mode includes: a joint angle closed-loop control mode, a stroke closed-loop control mode, or a drive quantity closed-loop control mode; the step of generating a first control command executable by the target slave excavator based on the target joint angle, according to the control mode of the target slave excavator, includes: The control mode of the target slave excavator is the joint angle closed-loop control mode, which directly generates joint angle control commands based on the target joint angle; When the control mode of the target slave excavator is the stroke amount closed-loop control mode, the target joint angle is converted into the corresponding stroke amount according to the kinematics of the slave link of the target slave excavator, and a stroke amount control command is generated based on the corresponding stroke amount. When the control mode of the target slave excavator is the drive quantity closed-loop control mode, the feedback joint angle of the target slave excavator is obtained, and the angle error between the feedback joint angle and the target joint angle is calculated; based on the angle error, the corresponding drive quantity is generated through the closed-loop control algorithm, and a drive quantity control command is generated based on the corresponding drive quantity.

[0008] In one possible implementation, converting the original joint angle into a target joint angle according to the joint angle mapping function corresponding to the target slave excavator includes: Based on the device profile parameter package, at least one of the following is performed on the original joint angle: zero-position compensation, direction correction, digital filtering, dead zone elimination, and telescopic structure compensation, to obtain the preprocessed original joint angle; Based on the joint angle mapping function corresponding to the target excavator, the preprocessed raw joint angles are converted into target joint angles.

[0009] In one possible implementation, after generating a first control command executable by the target slave excavator based on the target joint angle according to the control mode of the target slave excavator, the method further includes: The first control command is subjected to a safety protection verification to obtain a safety protection verification result; wherein, the safety protection verification includes: soft limit verification, motion rate limit verification, workspace interference verification, and communication feedback anomaly verification; The sending to the target slave excavator includes: When the security protection verification result is successful, the first control command is sent to the target slave excavator.

[0010] In one possible implementation, the method further includes: When the safety protection verification result is that the verification fails, the system will perform a mid-position hold, controlled deceleration shutdown, or degraded operation. The mid-position holding is the generation of a mid-position control command that stops the operation of each actuator of the target slave excavator, so that the target slave excavator maintains its current posture or stops operating. The controlled deceleration shutdown is achieved by controlling the actuators of the target excavator to decelerate to a stop according to a preset deceleration rate. The degraded operation restricts the target excavator's speed, range of motion, or available joints.

[0011] In one possible implementation, the device profile parameter package further includes: master-slave joint zero position, positive angle definition, joint motion limits, safety margin, link geometry, stroke range, speed threshold, acceleration threshold, and hydraulic dead zone.

[0012] In one possible implementation, the pre-calibrated equipment profile parameter package corresponding to the target slave excavator is obtained in the following manner: Obtain the device identifier of the target slave excavator; Adjust the master-end miniature excavator and the target slave-end excavator to a unified reference zero position, record the master-end joint zero position and the slave-end reference joint angle, and obtain the master-slave joint zero position; Drive each joint of the master miniature excavator and the target slave excavator to move in the forward and reverse directions to the boundary of the allowable range, collect the corresponding angle or stroke, and determine the positive angle direction, maximum range of motion, minimum range of motion and hardware safety boundary of each joint. The slave attitude feedback angle is collected according to the feedback form of the target slave excavator: if joint angle feedback is available, the real-time joint angle of the slave end is collected as the slave attitude feedback angle; if only cylinder or push rod stroke feedback is available, the stroke data is collected and converted into equivalent joint angles according to the linkage geometry as the slave attitude feedback angle; if there is no complete feedback, multiple sets of artificial feature posture points are collected as the slave attitude feedback angle. Based on the multiple sets of corresponding master joint angles and slave posture feedback angles obtained from the acquisition, a joint angle mapping function is fitted. Based on the active joint zero position, the positive angle direction, the maximum range of motion, the minimum range of motion, the hardware safety boundary, and the joint angle mapping function, as well as the linkage geometry, stroke range, speed threshold, acceleration threshold, and hydraulic dead zone of the target slave excavator itself, the equipment profile parameter package corresponding to the target slave excavator is obtained.

[0013] In one possible implementation, the method further includes: In response to a movement operation of the operating mechanism of the main-end miniature excavator, the original stroke of the operating mechanism of the main-end miniature excavator is acquired in real time; wherein, the original stroke is the linear motion stroke of the operating mechanism; Based on the device identifier of the target slave excavator connected to the master miniature excavator, obtain the stroke mapping function corresponding to the target slave excavator, and convert the original stroke amount into the target stroke amount based on the stroke mapping function; Based on the target travel distance, a second control command executable by the target slave excavator is generated and sent to the target slave excavator to control the target slave excavator to perform an action corresponding to the movement of the operating mechanism of the master miniature excavator; During the process of the target slave excavator performing an action corresponding to the stroke of the operating mechanism of the master miniature excavator, the actual stroke of the actuator of the target slave excavator is acquired in real time; Based on the target stroke and the actual stroke, the stroke error is obtained, and the second control command is compensated in real time according to the stroke error.

[0014] In one possible implementation, the travel mapping function includes at least one of the following: a linear mapping function, a piecewise nonlinear mapping function, and a multi-point calibration mapping function.

[0015] Secondly, embodiments of this application provide a remote operation control device for an excavator, applied to a master-end miniature excavator, the device comprising: The joint angle acquisition module is used to acquire the original joint angles of the operating mechanism of the main end miniature excavator in real time; The parameter package acquisition module is used to acquire a pre-calibrated equipment profile parameter package corresponding to the target slave excavator based on the equipment identifier of the target slave excavator connected to the master miniature excavator; wherein, the equipment profile parameters include at least: joint angle mapping function and control mode of the target slave excavator; The joint angle conversion module is used to convert the original joint angle into the target joint angle according to the joint angle mapping function corresponding to the target slave excavator; The instruction generation module is used to generate a first control instruction executable by the target slave excavator based on the target joint angle according to the control mode of the target slave excavator, and send it to the target slave excavator to control the target slave excavator to perform an action corresponding to the posture of the operating mechanism of the master miniature excavator.

[0016] Beneficial effects: By using the joint angles of the master-end miniature excavator's operating mechanism as a unified input for operational intent, and based on the equipment profile parameter package bound to the equipment identifier of the target slave excavator, the system completes the preprocessing of the master-end joint angles, master-slave joint angle mapping, and control command conversion for different control modes. This allows the same master-end miniature excavator to adapt to target slave excavators with different mechanical dimensions, feedback forms, and control interfaces. Furthermore, using the joint angles of the master-end miniature excavator as a unified input for operational intent enables the operator's operating postures of the master-end slewing, boom, stick, and bucket to intuitively correspond to the working device postures of the slave excavator, reducing the cognitive load on the operator who manually switches between handle direction, cylinder extension / retraction, and bucket end-effector movement. Attached Figure Description

[0017] To more clearly illustrate the technical solutions in the embodiments of this application or the prior art, the drawings used in the description of the embodiments or the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of this application. For those skilled in the art, other drawings can be obtained based on these drawings without creative effort.

[0018] Figure 1 This application provides a schematic diagram of the structure of a master-end miniature excavator. Figure 2 A flowchart illustrating a remote operation control method for an excavator provided in an embodiment of this application; Figure 3 A schematic diagram illustrating the pre-calibration process of the device profiling parameter package provided in the embodiments of this application; Figure 4 A flowchart illustrating another remote operation control method for an excavator provided in this application embodiment; Figure 5 This is a schematic diagram of the structure of a remote operation control device for an excavator provided in an embodiment of this application. Detailed Implementation

[0019] As described earlier, early excavator telecontrol systems mostly used heterogeneous master input devices such as two-dimensional joysticks, button arrays, or electric control handles. These devices directly converted the displacement or opening signals of the master handle into drive commands for the slave hydraulic proportional valves and multi-way valves. This type of solution has a simple structure and low modification cost. However, there is no direct geometric correspondence between the operator's hand movements and the spatial posture of the excavator's working device. In delicate operations such as slope trimming, trench excavation, and obstacle avoidance in confined spaces, the operator needs to rely on experience to mentally convert the multi-joint linkage relationships, which can easily lead to a high cognitive load and the risk of misoperation.

[0020] To improve operational intuitiveness, master-slave isomorphic teleoperation technology has been gradually applied. This technology ensures that the master-end miniature robotic arm is consistent with the slave-end excavator working device in terms of kinematic topology, degree of freedom configuration, and joint connection sequence. The operator can form corresponding posture input by swinging the joints of the master end. Compared with traditional handle control, it is more conducive to intuitively conveying the control intention of the slave end posture and end trajectory. However, existing isomorphic mapping schemes are often developed for specific machine models and lack a unified multimodal conversion and parameter management mechanism. It is difficult to adapt to the many differences in linkage ratio, zero-position reference, sensor configuration, hydraulic characteristics, and control interface of excavators from different manufacturers, tonnages, and service years.

[0021] Therefore, it can be seen that the current master-slave isomorphic teleoperation method is developed for specific machine models and lacks a universal adaptation mechanism, making it incompatible with various types of excavating equipment with different structural parameters, feedback forms and control interfaces.

[0022] This application provides a remote operation control method for an excavator, comprising: acquiring the original joint angles of the operating mechanism of a master miniature excavator in real time; acquiring a pre-calibrated equipment profile parameter package corresponding to the target slave excavator based on the equipment identifier of the target slave excavator connected to the master miniature excavator; converting the original joint angles into target joint angles according to the joint angle mapping function corresponding to the target slave excavator; generating a first control command executable by the target slave excavator based on the target joint angles according to the control mode of the target slave excavator, and sending it to the target slave excavator to control the target slave excavator to perform actions corresponding to the posture of the operating mechanism of the master miniature excavator. In the embodiments of this application, the joint angles of the operating mechanism of the master miniature excavator are used as a unified input of operating intent. Based on the equipment profile parameter package bound to the equipment identifier of the target slave excavator, the master joint angle preprocessing, master-slave joint angle mapping, and control command conversion for different control modes are completed, so that the same master miniature excavator can adapt to target slave excavators with different mechanical sizes, feedback forms, and control interfaces.

[0023] To enable those skilled in the art to better understand the present application, the technical solutions in the embodiments of the present application will be clearly and completely described below with reference to the accompanying drawings. Obviously, the described embodiments are only some embodiments of the present application, and not all embodiments. Based on the embodiments in the present application, all other embodiments obtained by those of ordinary skill in the art without creative effort are within the scope of protection of the present application.

[0024] The collection and processing of relevant data (including but not limited to experimental data, test data, simulation data, user data, etc.) involved in this application shall strictly comply with the requirements of national laws and regulations when applied in the following embodiments, obtain the informed consent or separate consent of the subject obtaining the data information, and carry out data use and processing within the scope of laws and regulations and the authorization of the subject.

[0025] Method Example 1: The following is combined Figures 1-3 This application provides a detailed description of a remote operation control method for an excavator, based on its embodiments.

[0026] First, the teleoperation method for an excavator provided in this application is applied to a master-end miniature excavator. A master-end miniature excavator refers to a miniature operating device for operator posture input, which has at least one or more motion joints corresponding to the working device of a slave-end excavator. For example, a master-end miniature excavator may have a slewing joint, a boom joint, a stick joint, and a bucket joint. The master-end miniature excavator and the target slave-end excavator may be kinematically topologically identical, or may only correspond in terms of joint functional semantics, without requiring them to have the same size or proportions.

[0027] To make it easier to understand, the following will be combined with... Figure 1 Let's take an example to illustrate the mechanism of a miniature excavator.

[0028] like Figure 1 As shown, the main-end miniature excavator includes a main-end end gripping operation unit 1, a main-end stick link 2, a bucket link or end linkage 3, a stick joint and its angle detection node 4, a boom support or drive simulation link and its angle detection node 5, a main-end boom link 6, a slewing base and mounting base plate 7, and a main-end controller and a display interaction or communication module 8.

[0029] The main end gripping control unit 1 is held by the operator and used to input bucket opening and closing, end posture, or end spatial position. The main end stick linkage 2 simulates the swing posture of the target excavator stick. The bucket linkage or end linkage 3 converts the operator's rotation of the main end gripping control unit 1 into changes in the bucket joint angle. The stick joint and its angle detection node 4 detect the stick's rotation angle relative to the boom. The boom support or drive simulation linkage and angle detection node 5 constrain and detect the pitch motion of the main end boom linkage 6. The slewing base and mounting plate 7 form the slewing degree of freedom of the main end miniature excavator and can be equipped with slewing zero position, limit structure, and slewing angle sensor.

[0030] Angle detection nodes can be absolute encoders, incremental encoders, magnetic encoders, potentiometers, rotary transformers, inertial measurement units (IMUs), or combinations of the above sensors.

[0031] like Figure 2 As shown in the figure, the remote operation control method for an excavator provided in this application includes the following steps: S201. Real-time acquisition of the original joint angles of the operating mechanism of the main end miniature excavator.

[0032] The original joint angle refers to the joint angle data obtained by directly reading the angle sensing unit at each joint of the main end, or by decoding the sensor base.

[0033] Specifically, the main end miniature excavator has four joints: swing, boom, stick, and bucket, so the four original joint angles of the operating mechanism are obtained.

[0034] For example, such as Figure 1 As shown, the original joint angles include: the turntable angle generated by the slewing base and mounting base plate 7, corresponding to the internal data field turret.angle_deg; the boom joint angle generated by the boom link 6, the boom support or drive simulation link, and the angle detection node 5, corresponding to boom.angle_deg; the stick joint angle generated by the stick link 2, the stick joint, and the angle detection node 4, corresponding to arm.angle_deg; and the bucket joint angle generated by the main end gripping operation part 1 and the bucket link or end linkage 3, corresponding to bucket.angle_deg.

[0035] Specifically, the master controller of the miniature excavator connects via CAN bus, serial bus, analog signal acquisition interface, SPI interface, and I / O. 2 The C-type interface or industrial Ethernet interface reads the output of each angle sensor and converts the sensor output values ​​into angle values ​​to obtain the original joint angle.

[0036] In this embodiment, by using joint angle as a unified input, the geometric posture between each link of the master operating mechanism can be directly expressed. Compared with simply using the rocker arm opening or proportional valve control, it is easier to establish the correspondence between the posture of the target slave excavator working device.

[0037] S202. Based on the device identifier of the target slave excavator connected to the master miniature excavator, obtain the pre-calibrated device profile parameter package corresponding to the target slave excavator.

[0038] The target slave excavator refers to the excavating equipment that has established a remote operation control relationship with the master miniature excavator and receives its control signals, including but not limited to hydraulic excavators, electric excavators, desktop excavators, remote operation verification platforms, and other construction machinery equipped with excavation working devices.

[0039] The equipment identifier is data used to distinguish different slave excavators or different slave control configurations. The equipment identifier can be the machine serial number, excavator identification code, controller serial number, control unit UID, communication node address, asset number, or a combination of the above information.

[0040] Among them, the equipment profile parameters are a set of parameters bound to the slave excavator, used to describe the slave excavator's mechanical structure, sensor characteristics, control interface, mapping relationship and safety boundary.

[0041] Specifically, the equipment profile parameter package includes at least: joint angle mapping function and control mode of the target slave excavator.

[0042] The joint angle mapping function refers to the mapping and transformation relationship between the input angles of each joint of the master miniature excavator and the output angles of the corresponding joints of the target slave excavator.

[0043] The control mode of a target-slave excavator refers to the type of control quantity used when the target-slave excavator receives and executes the control target in a closed loop. Specifically, the control modes of a target-slave excavator include: joint angle closed-loop control mode, stroke closed-loop control mode, or drive quantity closed-loop control mode.

[0044] Furthermore, the equipment profile parameter package also includes: master and slave joint zero position, positive angle definition, joint motion limits, safety margin, link geometry, stroke range, speed threshold, acceleration threshold, and hydraulic dead zone.

[0045] To make it easier to understand, the following will be combined with... Figure 3 This application describes in detail how a pre-calibrated device profile parameter package is obtained in the embodiments of this application.

[0046] S301. Obtain the device identifier of the target slave excavator.

[0047] Specifically, the device identifiers, such as the whole machine number, controller UID, communication node identifier, or asset management number, are read and used as the unique index of the device profile parameter package.

[0048] S302. Adjust the master-end miniature excavator and the target slave-end excavator to a unified reference zero position, record the master-end joint zero position and the slave-end reference joint angle, and obtain the master-slave joint zero position.

[0049] The unified reference zero point refers to the reference posture used to establish the posture correspondence between the master miniature excavator and the target slave excavator. The unified reference zero point does not require that the physical angle values ​​of each joint of the master and slave devices be exactly the same; it only requires that the posture has a clear corresponding semantics. For example, the unified reference zero point can be defined as follows: the slewing direction is directly forward, the boom is at a specified height, the stick is at a specified extension position, and the bucket cutting edge is in a specified posture.

[0050] Specifically, the master miniature excavator and the target slave excavator are adjusted to a unified reference zero position, and the joint angles read by each sensor in the master miniature excavator are recorded as the master joint zero position q. m0 And record each joint angle in the target end excavator as the slave end reference joint angle q. s0 .

[0051] If the target excavator only provides stroke feedback, the cylinder or push rod stroke at the reference zero position can be recorded and then converted into the reference joint angle of the target excavator based on the connecting rod geometry.

[0052] For example, under a unified reference zero position, if the master end boom sensor reading is 3° and the slave end boom joint angle is -8°, then 3° and -8° constitute a set of master and slave zero position parameters for the boom joint.

[0053] In this embodiment, the master-slave joint zero position provides a common reference for subsequent orientation correction and mapping function fitting, which can reduce fixed attitude deviation caused by assembly zero bias and differences in sensor installation position.

[0054] S303: Drive each joint of the master miniature excavator and the target slave excavator to move in the forward and reverse directions to the allowable range boundary, collect the corresponding angle or stroke, and determine the positive angle direction, maximum range of motion, minimum range of motion and hardware safety boundary of each joint.

[0055] Among them, the positive direction of the angle is used to specify the direction of movement when the joint angle increases; the maximum range of motion and the minimum range of motion are the angles or stroke boundaries that the joint can be used for normal control; the hardware safety boundary is the boundary that cannot be crossed when approaching the mechanical stop, the limit of the cylinder, or the structural interference position.

[0056] Specifically, the joints of the master-end miniature excavator and the target slave-end excavator are driven at low speed to move in two directions. During the movement, angle values, stroke values, and movement directions are collected to determine whether the signs of the angle changes of the master and slave joints are consistent, and to determine the positive direction of the angle, the maximum range of motion, and the minimum range of motion of each joint.

[0057] When a joint approaches the boundary of its permissible range, the hardware safety boundary can be determined through mechanical limits, travel limit switches, pressure rise characteristics, angle boundaries, or manual verification. Soft limits used for normal control are set within the hardware safety boundary, with a safety margin provided.

[0058] In this embodiment, the positive angle direction, maximum range of motion, minimum range of motion, and hardware safety boundary are used to prevent subsequent mapping results from having the opposite direction or exceeding the mechanical capabilities of the slave end, and to provide basic parameters for security protection verification.

[0059] S304. Collect the slave attitude feedback angle based on the feedback form of the target slave excavator.

[0060] Specifically, if joint angle feedback is available, the real-time joint angle of the slave end is collected as the slave end attitude feedback angle.

[0061] If the target excavator has angle sensors installed at its swing, boom, stick, and bucket, the real-time joint angles of the target excavator can be directly collected. For example, the boom angle field in the target excavator's CAN message can be directly read as the boom attitude feedback angle.

[0062] The joint angle feedback link is short and the conversion error is small, which makes it easy to establish high-precision mapping samples.

[0063] Specifically, if only cylinder or push rod stroke feedback is available, the stroke data is collected and converted into an equivalent joint angle based on the linkage geometry as the slave end attitude feedback angle.

[0064] If the target excavator is only equipped with a cylinder stroke sensor or an electric push rod position sensor, the stroke amount is collected and converted into an equivalent joint angle based on the geometry of the push rod. For example, the boom joint angle is calculated using the law of cosines based on the boom cylinder length and the positions of the hinge points at both ends of the cylinder. Even with only cylinder or push rod stroke feedback, although the push rod attitude feedback angle cannot be directly measured, a unified joint angle calibration data can still be generated without the need for additional joint angle sensors.

[0065] Specifically, if there is no complete feedback, multiple sets of artificial feature pose points are collected as slave pose feedback angles.

[0066] If the target excavator lacks continuous angle and stroke feedback, calibration personnel can adjust the end-working device to multiple identifiable artificial characteristic postures. The corresponding end-position feedback angles can then be recorded using external angle measuring tools, visual measurement, mechanical positioning fixtures, or manual input. Artificial characteristic posture points can include postures such as fully retracted bucket, fully unloaded bucket, maximum stick extension, specified boom height, and horizontal bucket edge. By manually collecting end-position feedback angles, even older equipment or equipment with incomplete feedback can establish mapping relationships through discrete samples.

[0067] S305. Based on the multiple sets of corresponding master joint angles and slave posture feedback angles obtained from the acquisition, a joint angle mapping function is fitted.

[0068] Among them, multiple sets of corresponding master end joint angles and slave end attitude feedback angles are used as multiple sets of calibration samples. Each set of calibration samples includes the corresponding master end joint angle and slave end attitude feedback angle under the same attitude.

[0069] Specifically, based on the multiple sets of corresponding master joint angles and slave posture feedback angles collected, a joint angle mapping function is fitted to obtain the joint angle mapping function, which is used to predict the corresponding slave target joint angle based on the master joint angle.

[0070] In this embodiment of the application, by fitting the mapping function with the actual measured corresponding sample of a single device, the differences in arm length, link ratio, sensor installation posture and mechanical nonlinearity of different models can be compensated.

[0071] For example, the joint angle mapping function can be represented as q_ =g(q_m), q_ q_m is the target joint angle (i.e., the joint angle of the target slave excavator), g is the original joint angle (i.e., the joint angle of the master miniature excavator), and g is the joint angle mapping function.

[0072] In one possible implementation, the joint angle mapping function can be represented in the following forms: linear proportional mapping, piecewise linear mapping, multi-point interpolation lookup table, polynomial nonlinear mapping, and whole-machine kinematic correction model.

[0073] Piecewise linear mapping divides the range of motion of the main joint into multiple intervals, each interval using a different slope and offset. Piecewise linear mapping is suitable for situations where the joint has different motion ratios or hydraulic responses in different angular intervals.

[0074] Among them, multi-point interpolation lookup table stores multiple sets of master joint angles and slave attitude feedback angles obtained from calibration into a mapping table according to the joint order. During runtime, linear interpolation, spline interpolation or multidimensional interpolation is used to calculate the target joint angle.

[0075] Among them, polynomial nonlinear mapping can be used to compensate for mapping deviations caused by differences in link ratios, sensor nonlinearity, and mechanical backlash.

[0076] The overall kinematics correction model first calculates the desired position and attitude of the master end based on the master end's forward kinematics, and then, combined with the slave end's link dimensions, obtains the target joint angle through the slave end's inverse kinematics. This model is suitable for situations where the master and slave boom lengths differ significantly, and where maintaining the corresponding trajectory of the bucket end is paramount.

[0077] S306. Based on the active joint zero position, positive angle direction, maximum range of motion, minimum range of motion, hardware safety boundary and joint angle mapping function, as well as the linkage geometry, stroke range, speed threshold, acceleration threshold and hydraulic dead zone of the target slave excavator itself, the equipment profile parameter package corresponding to the target slave excavator is obtained.

[0078] Specifically, parameters such as the master-slave joint zero position, positive angle direction, maximum range of motion, minimum range of motion, hardware safety boundary, joint angle mapping function, link geometry, stroke range, speed threshold, acceleration threshold, and hydraulic dead zone are encapsulated according to a preset data structure and associated with the device identifier to obtain the device profile parameter package corresponding to the target slave excavator, and the device profile parameter package is stored. When the target slave excavator reconnects, the master miniature excavator directly reads the device profile parameter package based on the device identifier, without needing to recalibrate the device profile parameter package.

[0079] In this embodiment of the application, by uniformly encapsulating mechanical parameters, control parameters and safety parameters, the inconsistency of parameters caused by the separate configuration of different software modules can be reduced, and the target slave excavator can be switched easily, thereby adapting to slave excavators with different structural parameters, feedback forms and control interfaces.

[0080] The above combination Figure 3 This application provides a detailed explanation of how the device profile parameter package is obtained in its embodiments. The following section will continue in conjunction with... Figure 2 This application provides a detailed description of a remote operation control method for an excavator, based on embodiments of the present application.

[0081] S203. Based on the joint angle mapping function corresponding to the target excavator, convert the original joint angles into target joint angles.

[0082] Specifically, the target joint angle corresponding to the original joint angle is obtained through the joint angle mapping function and the original joint angle.

[0083] For example, the joint angle mapping function is q_ =-10+1.6q_m, original joint angle q_m=25°, then the corresponding target joint angle q_ =30°.

[0084] In one possible implementation, based on the equipment profile parameter package, at least one of the following is performed on the original joint angle: zero-position compensation, direction correction, digital filtering, dead zone elimination, and telescopic structure compensation, to obtain the preprocessed original joint angle; based on the joint angle mapping function corresponding to the target slave excavator, the preprocessed original joint angle is converted into the target joint angle.

[0085] Zero-position compensation refers to eliminating the deviation between the sensor zero position of the main-end miniature excavator, the mechanical reference zero position of the main-end miniature excavator, and the calibration reference zero position.

[0086] For example, when the boom of the main-end miniature excavator is at the unified reference zero position, the sensor reading is 3°. Then, 3° can be recorded as the zero position of the boom joint of the main-end miniature excavator. If the original joint angle is 23°, the original joint angle after zero position compensation is 20°.

[0087] Direction correction refers to ensuring that the same operational semantics correspond to the same direction of numerical change, based on the positive definition of the master-slave joint angle. Direction correction can prevent reverse motion issues such as the master miniature excavator raising its operating components while the corresponding actuator of the target slave excavator lowers, or the master miniature excavator retracting its bucket while the target slave excavator unloads its bucket.

[0088] Digital filtering refers to suppressing joint angle jitter caused by sensor noise, structural micro-vibrations, or communication quantization errors. Digital filtering can employ moving average filtering, median filtering, low-pass filtering, Kalman filtering, or exponential smoothing filtering. Digital filtering can reduce frequent micro-movements at the valve port and jitter in the operating device, improving the smoothness of remote operation.

[0089] Deadzone elimination can include master-end sensing deadzone processing and slave-end hydraulic deadzone compensation. Master-end sensing deadzone processing is used to eliminate small joint angle fluctuations when the operator does not perform effective operation; slave-end hydraulic deadzone compensation is used to compensate for the area where proportional valves, electric control handles, or hydraulic actuators do not move under small drive amounts. Deadzone elimination can simultaneously reduce unintentional micro-movements and improve the problem of small operations not driving slave-end movement.

[0090] Telescopic structure compensation refers to using the current telescopic length of the master excavator as a mapping parameter to correct the original joint angle or end trajectory. When the boom, stick, or bucket section of the master excavator is telescopic, changes in the link length will alter the kinematic relationship between the master end position and the joint angle. Therefore, telescopic structure compensation enables the master excavator with adjustable boom length to adapt to slave excavators with different boom lengths and link ratios.

[0091] In this embodiment, the preprocessed original joint angle is converted into a target joint angle, which can uniformly handle the differences in master-slave zero position, direction, range, linkage ratio and nonlinear response, so that the target joint angle can more accurately reflect the operator's posture intention and reduce the distortion of the excavator's movement amplitude and the deviation of the end trajectory.

[0092] S204. Based on the control mode of the target slave excavator and the target joint angle, generate the first control command that the target slave excavator can execute and send it to the target slave excavator to control the target slave excavator to perform actions corresponding to the posture of the operating mechanism of the master miniature excavator.

[0093] The "posture correspondence" refers to the predetermined action correspondence between the functional joints of the master miniature excavator and the target slave excavator, without limiting the joint angle values, movement speed, or end displacement of the two to be exactly the same.

[0094] Among them, the control mode refers to the type of control quantity used when the target receives and executes the control target in a closed loop from the end excavator.

[0095] In one possible implementation, the control mode of the target slave excavator is a joint angle closed-loop control mode, which directly generates joint angle control commands based on the target joint angle.

[0096] Among them, the joint angle closed-loop control mode refers to the target slave excavator being able to receive the joint angle target and control each actuator according to the joint angle feedback collected by the machine, so that the feedback joint angle follows the target joint angle.

[0097] Specifically, the target slave excavator operates in a joint angle closed-loop control mode, directly encapsulating the target joint angle into joint angle control commands. For slave excavators with joint angle closed-loop control capabilities, the attitude target can be directly transmitted, reducing the master excavator's dependence on the slave excavator's hydraulic execution details.

[0098] In one possible implementation, the target slave excavator is controlled in a stroke-based closed-loop control mode. Based on the kinematics of the slave link of the target slave excavator, the target joint angle is converted into the corresponding stroke, and a stroke control command is generated based on the corresponding stroke.

[0099] The stroke refers to the length, extension, or displacement of the hydraulic cylinder, electric actuator, or other linear actuator used to drive the excavator's working device.

[0100] Among them, the stroke closed-loop control mode refers to the target slave excavator making the actuator reach the target stroke based on the feedback from the stroke sensor.

[0101] For example, assuming the target boom angle of 30° corresponds to a boom cylinder length of 720mm after conversion by linkage kinematics, a stroke control command is generated based on the stroke of 720mm.

[0102] In this embodiment of the application, by converting a unified target joint angle into a corresponding stroke amount, the slave excavator, which only supports the stroke amount closed-loop control mode, can perform actions corresponding to the posture of the master miniature excavator, thereby expanding the compatibility range of the remotely operated slave excavator.

[0103] In one possible implementation, the target slave excavator is controlled in a drive quantity closed-loop control mode. The feedback joint angle of the target slave excavator is obtained, and the angle error between the feedback joint angle and the target joint angle is calculated. Based on the angle error, the corresponding drive quantity is generated through the closed-loop control algorithm, and a drive quantity control command is generated based on the corresponding drive quantity.

[0104] Among them, the driving quantity refers to the control quantity that directly acts on the execution interface of the slave excavator, including: proportional valve current, proportional valve voltage, PWM duty cycle, valve core opening, equivalent handle displacement or motor torque command.

[0105] Among them, the drive quantity closed-loop control mode refers to the master miniature excavator calculating the drive quantity required by the execution interface of the slave excavator based on the error between the target joint angle and the feedback joint angle.

[0106] Specifically, if the target slave excavator has an angle sensor, the real-time joint angle is directly read as the feedback joint angle; if the target slave excavator only has a cylinder or push rod stroke sensor, the feedback joint angle is calculated based on the stroke amount and the geometry of the slave connecting rod.

[0107] The closed-loop control algorithm can be PID control, gain-scheduled PID, adaptive control, model predictive control, sliding mode control, or other algorithms that can generate driving forces based on angle errors.

[0108] In this embodiment, by using the error between the target joint angle and the feedback joint angle as the control basis, even if the excavator at the slave end can only receive input from the proportional valve, PWM, or electric control handle, a posture closed loop can be formed, reducing the posture error caused by the simple open-loop drive being affected by load, oil temperature, pressure, and hydraulic dead zone.

[0109] In one possible implementation, to ensure the safety of controlling the slave excavator, after generating the first control signal, the first control command is subjected to a safety protection verification to obtain a safety protection verification result; when the safety protection verification result is that the verification is passed, the first control command is sent to the target slave excavator.

[0110] The safety protection verification includes: soft limit verification, motion rate limit verification, workspace interference verification, and communication feedback anomaly verification.

[0111] Soft limits are control boundaries set within the mechanical limits of the hardware. Soft limits can be determined based on the maximum range of motion, minimum range of motion, and safety margin. For example, if the hardware range of motion of a joint is -40° to 120° and the safety margin is 5°, then the soft limit can be set to -35° to 115°.

[0112] Specifically, for joint angle control commands, the target joint angle is verified; for stroke control commands, the target cylinder or push rod stroke is verified; for drive control commands, the drive direction and the possible position reached after continuous drive are verified.

[0113] In this embodiment, the soft limit check can prevent the joint from continuing to move before reaching the mechanical stop, reducing the risk of structural impact and sensor damage.

[0114] Among them, the motion rate limit check is used to determine whether the rate of change and acceleration of the target joint angle, target stroke, or target drive exceeds the speed threshold and acceleration threshold in the device profile.

[0115] In this embodiment, rate limiting can reduce the risk of instability caused by hydraulic shock, structural vibration, and rapid changes in the operating mechanism.

[0116] Among them, workspace interference verification refers to jointly considering the postures of slewing, boom, stick, bucket, and attachments to determine whether the target posture will cause the mechanism to buckle, self-collision, collision with the cab or tracks, ground contact, or enter a pre-set danger zone.

[0117] In this embodiment, the workspace interference verification can compensate for the inadequacy of only checking single joint limits and failing to identify collisions involving multiple joint combinations.

[0118] Among them, the communication feedback anomaly verification is used to determine whether the master-slave communication link and the feedback from the slave end meet the safety control requirements. It can include: communication message timeout, message sequence number discontinuity, timestamp expiration, check code error, mismatch of the device identifier of the target slave excavator, joint angle sensor failure, stroke sensor failure, the error between the target joint angle and the feedback joint angle exceeding the threshold for a long time, the feedback angular velocity being inconsistent with the control direction, emergency stop signal triggering, safety enable signal disconnection, etc.

[0119] In this embodiment, the communication feedback anomaly verification can prevent the continued transmission of the first control command when feedback fails, communication is interrupted, or the device is connected to the wrong device.

[0120] Furthermore, when the safety protection verification result is that the verification fails, the system will perform a mid-position hold, controlled deceleration shutdown, or degraded operation.

[0121] Specifically, if at least one of the following checks fails: soft limit check, motion rate limit check, workspace interference check, and communication feedback anomaly check, the security protection check result is "check failed".

[0122] Among them, the center position hold is a center position control command that stops the operation of each actuator of the target slave excavator, so that the target slave excavator maintains its current posture or stops moving. The center position hold can quickly cut off the control intention to continue movement, and is suitable for handling situations such as emergency stop, communication message error or slight overstepping.

[0123] Controlled deceleration shutdown involves slowing down each actuator of the excavator to a stop according to a preset deceleration control target. For scenarios involving heavy-duty booms, rapid slewing, or sudden centering that may cause significant hydraulic shock, controlled deceleration shutdown can reduce structural vibration, load sway, and hydraulic shock.

[0124] Degraded operation involves restricting the movement speed, range of motion, or available joints of the target excavator, including limiting movement speed, range of motion, maximum drive, or disabling certain joints. Degraded operation preserves necessary evacuation, reset, or retraction capabilities while meeting safety requirements, avoiding secondary risks associated with immediate shutdown for all anomalies.

[0125] This application provides a method for remote operation control of an excavator, including: acquiring the original joint angles of the operating mechanism of a master miniature excavator in real time; acquiring a pre-calibrated equipment profile parameter package corresponding to the target slave excavator based on the equipment identifier of the target slave excavator connected to the master miniature excavator; converting the original joint angles into target joint angles according to the joint angle mapping function corresponding to the target slave excavator; generating a first control command executable by the target slave excavator based on the target joint angles according to the control mode of the target slave excavator, and sending it to the target slave excavator to control the target slave excavator to perform actions corresponding to the posture of the operating mechanism of the master miniature excavator. In this application embodiment, the joint angles of the operating mechanism of the master miniature excavator are used as a unified input of operating intent. Based on the equipment profile parameter package bound to the equipment identifier of the target slave excavator, the master joint angle preprocessing, master-slave joint angle mapping, and control command conversion for different control modes are completed, so that the same master miniature excavator can adapt to target slave excavators with different mechanical sizes, feedback forms, and control interfaces.

[0126] Furthermore, by using the joint angle of the main end miniature excavator as a unified input for operating intent, the operator's operating postures for the main end rotation, boom, stick, and bucket can be intuitively correlated with the working device postures of the slave end excavator, reducing the cognitive load on the operator who has to manually switch between handle direction, cylinder extension and retraction, and bucket end movement.

[0127] Furthermore, by using the equipment profile parameter package corresponding to the target slave excavator, the same master miniature excavator can be adapted to slave excavators of different manufacturers, tonnages, boom lengths, feedback methods, and control interfaces by loading different equipment profile parameter packages.

[0128] Method Example 2: The following is combined Figure 4 This application provides a detailed description of another remote operation control method for excavators provided in its embodiments.

[0129] Based on the remote operation control based on joint angle mapping provided in the above method embodiment, the linear motion stroke of the operating mechanism of the master miniature excavator is further utilized to control the hydraulic cylinder, electric push rod or other linear actuator of the target slave excavator.

[0130] like Figure 4 As shown in the embodiment of this application, another method for remotely controlling an excavator includes the following steps: S401, In response to the movement operation of the operating mechanism of the main miniature excavator, the original stroke of the operating mechanism of the main miniature excavator is obtained in real time.

[0131] Among them, moving operation refers to the operation in which the operator pushes, pulls, extends, or moves the operating mechanism of the main end miniature excavator, causing the operating mechanism or the linear motion component connected to the operating mechanism to be displaced.

[0132] The original stroke is the linear motion stroke of the operating mechanism, which is directly collected by the stroke detection module installed on the main end of the miniature excavator, or obtained by basic decoding of the output signal of the stroke detection module. Specifically, the original stroke represents the extension length, retraction length, or linear displacement of the operating mechanism relative to a preset reference position, and is not the joint angle formed by the movement of the operating mechanism around the rotation axis.

[0133] Specifically, the stroke detection module can be set inside the miniature excavator at the main end, at the linear guide rail, at the simulated hydraulic cylinder, or at a position where linear relative motion occurs between links. The stroke detection module can use linear displacement sensors, wire displacement sensors, resistive displacement sensors, magnetic grating displacement sensors, magnetostrictive displacement sensors, optical grating rulers, or other sensors capable of detecting linear motion distance.

[0134] In this embodiment of the application, by directly obtaining the linear motion stroke (i.e., the original stroke amount) of the operating mechanism of the main end miniature excavator, the input data of the main end and the motion amount of the linear actuators such as the hydraulic cylinder and electric push rod of the slave end can have the same physical quantity type, thereby reducing the conversion error and calculation error of the main end stroke.

[0135] S402. Based on the device identifier of the target slave excavator connected to the master miniature excavator, obtain the stroke mapping function corresponding to the target slave excavator, and convert the original stroke amount into the target stroke amount based on the stroke mapping function.

[0136] The stroke mapping function is used to describe the correspondence between the stroke of the operating mechanism of the master miniature excavator and the target stroke of the actuator of the target slave excavator.

[0137] The target stroke can be the total length of the cylinder, the extension of the cylinder piston rod relative to the fully retracted position, the position of the electric push rod, or the displacement of other linear actuators relative to the preset zero position.

[0138] The travel mapping function can include at least one of linear mapping functions, piecewise nonlinear mapping functions, and multi-point calibration mapping functions. Different actuators can use different forms of travel mapping functions, and the same actuator can also switch between different travel mapping functions according to the operating mode or travel range.

[0139] A linear mapping function refers to converting the original travel amount into the target travel amount of the slave end according to a fixed proportional coefficient within the effective travel range of the master end miniature excavator. Linear mapping functions have a simple structure and low computational cost, making them easy to calculate within a short control cycle. They are suitable for scenarios where the motion patterns of the master and slave actuators are similar or where high real-time performance is required.

[0140] Piecewise nonlinear mapping functions refer to dividing the effective stroke of a miniature excavator into multiple intervals and setting different mapping gains, mapping curves, or compensation parameters for different intervals. Piecewise nonlinear mapping can configure different control sensitivities according to different motion intervals, and can be used to compensate for valve control dead zones, mechanical backlash, and hydraulic response nonlinearity, improve the accuracy of small-stroke operation, and reduce the impact of actuator movement when approaching the stroke limit.

[0141] A multi-point calibration mapping function refers to a mapping function established based on the measured correspondence data of multiple sets of master-end miniature excavator strokes and target slave-end excavator strokes. Multi-point calibration mapping is based on the actual measurement data of the target slave-end excavator and can comprehensively compensate for equipment size errors, actuator installation errors, mechanical clearances, and differences in motion characteristics between different devices. Compared with fixed-ratio mapping determined solely by theoretical dimensions, it has higher equipment adaptation accuracy.

[0142] In this embodiment of the application, by binding the stroke mapping function with the device identifier, it is possible to adapt to different target slave excavators with different tonnages, different connecting rod sizes, different cylinder strokes and different mechanical installation errors, thereby avoiding overtravel or insufficient stroke utilization caused by using the same fixed proportional parameters to control all slave devices.

[0143] S403. Based on the target stroke, generate a second control command that can be executed by the target slave excavator and send it to the target slave excavator to control the target slave excavator to perform actions corresponding to the movement of the operating mechanism of the master miniature excavator.

[0144] The second control command refers to a control command generated based on the target travel distance, which can be directly received by the target slave excavator or executed after being parsed by its slave controller.

[0145] It should be noted that "second" is only used to distinguish this control command from the first control command generated based on the target joint angle, and does not mean that the two must be generated or sent in a fixed order.

[0146] Specifically, the second control command can be a stroke position command, or a valve control command, motor drive command, or other execution interface command calculated with the target stroke amount as the control target.

[0147] When the target slave excavator supports closed-loop control of stroke, the second control command can directly include the target stroke of each actuator.

[0148] When the target slave excavator can only receive drive signals from hydraulic proportional valves, solenoid valves, motors, or electro-hydraulic proportional actuators, an initial drive quantity can be generated based on the target stroke and a pre-calibrated feedforward control relationship, and this initial drive quantity can be encapsulated as a second control command. The drive quantity may include proportional valve current, proportional valve voltage, PWM duty cycle, valve spool opening, or motor drive force.

[0149] In the embodiments of this application, by directly converting the stroke of the master miniature excavator into control commands that can be executed by the target slave excavator, the control target is made closer to the actual movement of the hydraulic cylinder or electric push rod, which can reduce intermediate kinematic conversion links and facilitate direct amplitude limiting and closed-loop control of the actuator stroke.

[0150] S404. During the process of the target slave excavator performing an action corresponding to the stroke of the operating mechanism of the master miniature excavator, the actual stroke of the actuator of the target slave excavator is obtained in real time.

[0151] The actual travel distance refers to the actual extension or linear displacement achieved by the actuator of the target excavator during the execution of the second control command.

[0152] Specifically, magnetostrictive displacement sensors, wire displacement sensors, linear encoders, or other stroke sensors can be installed on the boom cylinder, stick cylinder, and bucket cylinder of the target-end miniature excavator. The target-end controller periodically collects the actual stroke of each actuator and feeds it back to the master-end miniature excavator via a communication link.

[0153] Furthermore, as the actual travel volume is fed back, the corresponding sampling timestamp can also be fed back simultaneously, and then the target travel volume and the actual travel volume can be synchronized in time based on the sampling timestamp.

[0154] In this embodiment of the application, by collecting the actual stroke amount of the slave end in real time, it is possible to directly determine whether the slave end actuator is moving according to the target stroke, providing a feedback basis for eliminating the following error caused by load changes, hydraulic pressure fluctuations, mechanical friction and actuator wear.

[0155] S405. Based on the target stroke and the actual stroke, the stroke error is obtained, and the second control command is compensated in real time according to the stroke error.

[0156] Among them, the travel error refers to the difference between the target travel amount and the actual travel amount.

[0157] Specifically, when the travel error is positive, it means that the actual travel of the actuator has not reached the target travel; when the travel error is negative, it means that the actual travel of the actuator has exceeded the target travel.

[0158] In one possible implementation, proportional control, proportional-integral control, PID control, gain-scheduled control, adaptive control, or model predictive control are used to compensate the second control command in real time based on the stroke error.

[0159] Furthermore, to prevent excessive compensation, the compensation result can be limited based on the maximum drive quantity, maximum target speed, maximum stroke correction, and integral limit corresponding to the target excavator. If the stroke error is less than the preset allowable error, the compensation quantity can be set to zero or only position holding can be performed to reduce repeated micro-movements of the actuator near the target position.

[0160] In this embodiment, by real-time compensation of the second control command based on the error between the target stroke and the actual stroke, the influence of hydraulic pressure changes, working load changes, oil temperature changes, mechanical friction, mechanical clearance and actuator wear on the control results can be reduced, so that the actual stroke of the slave actuator continuously follows the target stroke, thereby improving the consistency of master and slave actions, position control accuracy and anti-interference ability.

[0161] This application provides a remote operation control method for an excavator, comprising: in response to a movement operation of the operating mechanism of a master miniature excavator, acquiring in real time the original travel amount of the operating mechanism of the master miniature excavator; acquiring a travel mapping function corresponding to the target slave excavator based on the device identifier of the target slave excavator connected to the master miniature excavator, and converting the original travel amount into a target travel amount based on the travel mapping function; generating a second control command executable by the target slave excavator based on the target travel amount, and sending it to the target slave excavator to control the target slave excavator to perform an action corresponding to the movement of the operating mechanism of the master miniature excavator; acquiring in real time the actual travel amount of the actuator of the target slave excavator during the execution of the action corresponding to the travel of the operating mechanism of the master miniature excavator; obtaining a travel amount error based on the target travel amount and the actual travel amount, and compensating the second control command in real time based on the travel amount error. In this embodiment, the stroke amount is used as the control quantity for master-slave mapping, which matches the driving characteristics of the excavator's hydraulic actuator. By matching the dedicated stroke mapping function of the target slave device, the conversion from master input to slave target stroke is completed. At the same time, combined with the actual stroke feedback from the slave end, a closed-loop error real-time compensation is formed, which effectively offsets the control deviation caused by factors such as hydraulic system nonlinearity and load fluctuation, significantly improves the consistency and control accuracy of master-slave actions, and ensures the accuracy and operational stability of remote operation.

[0162] Device Example: The following is combined Figure 5 This application also provides a remote operation control device for excavators, which is applied to a master miniature excavator.

[0163] like Figure 5 As shown in the embodiment of this application, a remote operation control device for an excavator includes the following modules: The joint angle acquisition module 501 is used to acquire the original joint angles of the operating mechanism of the main end miniature excavator in real time. The parameter package acquisition module 502 is used to acquire a pre-calibrated equipment profile parameter package corresponding to the target slave excavator based on the equipment identifier of the target slave excavator connected to the master miniature excavator; wherein, the equipment profile parameters include at least: joint angle mapping function and control mode of the target slave excavator; The joint angle conversion module 503 is used to convert the original joint angle into the target joint angle according to the joint angle mapping function corresponding to the target slave excavator; The instruction generation module 504 is used to generate a first control instruction executable by the target slave excavator based on the target joint angle according to the control mode of the target slave excavator, and send it to the target slave excavator to control the target slave excavator to perform actions corresponding to the posture of the operating mechanism of the master miniature excavator.

[0164] In one possible implementation, the control modes include: joint angle closed-loop control mode, stroke closed-loop control mode, or drive quantity closed-loop control mode; the instruction generation module 504 is specifically used for: The control mode of the excavator at the target end is the joint angle closed-loop control mode, which directly generates joint angle control commands based on the target joint angle. The target slave excavator is controlled in a stroke closed-loop control mode. Based on the kinematics of the slave link of the target slave excavator, the target joint angle is converted into the corresponding stroke, and stroke control commands are generated based on the corresponding stroke. In the target slave excavator's control mode, which is the drive quantity closed-loop control mode, the feedback joint angle of the target slave excavator is obtained, and the angle error between the feedback joint angle and the target joint angle is calculated. Based on the angle error, the corresponding drive quantity is generated through the closed-loop control algorithm, and the drive quantity control command is generated based on the corresponding drive quantity.

[0165] In one possible implementation, the joint angle conversion module 503 is specifically used to perform at least one of zero-position compensation, direction correction, digital filtering, dead zone elimination, and telescopic structure compensation on the original joint angle according to the equipment profile parameter package to obtain the preprocessed original joint angle; and convert the preprocessed original joint angle into the target joint angle according to the joint angle mapping function corresponding to the target slave excavator.

[0166] In one possible implementation, the device further includes: an instruction verification module, used to perform safety protection verification on the first control instruction and obtain a safety protection verification result; wherein, the safety protection verification includes: soft limit verification, motion rate limit verification, workspace interference verification and communication feedback anomaly verification; The instruction generation module 504 is specifically used to send the first control instruction to the target slave excavator when the safety protection verification result is that the verification is passed.

[0167] In one possible implementation, the device further includes: an anomaly control module, used to execute neutral position holding, controlled deceleration shutdown, or degraded operation when the safety protection verification result is a failure; neutral position holding generates a neutral position control command to stop the operation of each actuator of the target slave excavator, so that the target slave excavator maintains its current posture or stops moving; controlled deceleration shutdown controls each actuator of the target slave excavator to decelerate to a stop according to a preset deceleration rate; degraded operation limits the movement speed, movement range, or available joints of the target slave excavator.

[0168] In one possible implementation, the device further includes: a device profiling module, used for: Obtain the device identifier of the target slave excavator; Adjust the master-end miniature excavator and the target slave-end excavator to a unified reference zero position, record the master-end joint zero position and the slave-end reference joint angle, and obtain the master-slave joint zero position; Drive each joint of the master miniature excavator and the target slave excavator to move in the forward and reverse directions to the boundary of the allowable range, collect the corresponding angle or stroke, and determine the positive angle direction, maximum range of motion, minimum range of motion and hardware safety boundary of each joint. The slave attitude feedback angle is collected based on the feedback form of the target slave excavator: if joint angle feedback is available, the real-time joint angle of the slave end is collected as the slave attitude feedback angle; if only cylinder or push rod stroke feedback is available, the stroke data is collected and converted into equivalent joint angles based on the linkage geometry as the slave attitude feedback angle; if there is no complete feedback, multiple sets of artificial feature posture points are collected as the slave attitude feedback angle. Based on the multiple sets of corresponding master joint angles and slave posture feedback angles obtained from the acquisition, a joint angle mapping function is fitted. Based on the active joint zero position, positive angle direction, maximum range of motion, minimum range of motion, hardware safety boundary, and joint angle mapping function, as well as the linkage geometry, stroke range, speed threshold, acceleration threshold, and hydraulic dead zone of the target slave excavator itself, the equipment profile parameter package corresponding to the target slave excavator is obtained.

[0169] In one possible implementation, the device further includes: a stroke acquisition module, a stroke conversion module, a stroke control module, a stroke feedback module, and a stroke compensation module.

[0170] The stroke acquisition module is used to acquire the original stroke of the operating mechanism of the main end miniature excavator in real time in response to the movement operation of the operating mechanism; wherein, the original stroke is the linear motion stroke of the operating mechanism. The stroke conversion module is used to obtain the stroke mapping function corresponding to the target slave excavator based on the device identifier of the target slave excavator connected to the master mini excavator, and convert the original stroke amount into the target stroke amount based on the stroke mapping function; The stroke control module is used to generate a second control command that can be executed by the target slave excavator according to the target stroke, and send it to the target slave excavator to control the target slave excavator to perform actions corresponding to the movement of the operating mechanism of the master miniature excavator. The stroke feedback module is used to obtain the actual stroke of the actuator of the target slave excavator in real time during the process of the target slave excavator performing the action corresponding to the stroke of the operating mechanism of the master mini excavator; The stroke compensation module is used to obtain the stroke error based on the target stroke and the actual stroke, and to compensate the second control command in real time according to the stroke error.

[0171] It should be noted that the excavator remote operation control device provided in this application embodiment has the same beneficial effects as the excavator remote operation control method provided in the above embodiments, so it will not be described again.

[0172] In one possible implementation, this application also provides a master controller.

[0173] The master controller may include memory and a processor. The memory may be random access memory (RAM), flash memory, read-only memory (ROM), EPROM, non-volatile read-only memory (Electronic Programmable ROM), registers, hard disk, removable disk, etc.

[0174] The memory can store computer instructions, which, when executed by the processor, can be used to perform remote control methods for the excavator. The memory can also store data.

[0175] In the above embodiments, implementation can be achieved, in whole or in part, through software, hardware, firmware, or any combination thereof. When implemented in software, it can be implemented, in whole or in part, as a computer program product. A computer program product includes one or more computer instructions. When the computer program instructions are loaded and executed on a computer, all or part of the flow or function according to the embodiments of this application is generated. The computer can be a general-purpose computer, a special-purpose computer, a computer network, or other programmable device. The computer instructions can be stored in a computer-readable storage medium or transmitted from one computer-readable storage medium to another. For example, computer instructions can be transmitted from one website, computer, server, or data center to another website, computer, server, or data center via wired (e.g., coaxial cable, fiber optic, digital subscriber line (DSL)) or wireless (e.g., infrared, wireless, microwave, etc.) means. The computer-readable storage medium can be any available medium that a computer can access or a data storage device such as a server or data center that integrates one or more available media. The available medium can be a magnetic medium (e.g., floppy disk, hard disk, magnetic tape) or a semiconductor medium (e.g., solid-state disk (SSD)).

[0176] This application also provides a readable storage medium for storing the methods provided in the above embodiments. Examples include random access memory (RAM), flash memory, read-only memory (ROM), EPROM, non-volatile read-only memory (EPROM), registers, hard disks, removable disks, or any other form of storage medium in the art.

[0177] In the embodiments of this application, the terms "first" and "second" (if they exist) are used only as name identifiers and do not represent the order of first and second.

[0178] It should be noted that the various embodiments in this specification are described in a progressive manner, with each embodiment focusing on the differences from other embodiments. Similar or identical parts between embodiments can be referred to interchangeably. Regarding the methods disclosed in the embodiments, since they correspond to the product embodiments disclosed in the embodiments, the description is relatively simple; relevant parts can be referred to in the description of the product embodiments.

[0179] The above description of the disclosed embodiments enables those skilled in the art to make or use this application. Various modifications to these embodiments will be readily apparent to those skilled in the art, and the general principles defined herein may be implemented in other embodiments without departing from the spirit or scope of this application. Therefore, this application is not to be limited to the embodiments shown herein, but is to be accorded the widest scope consistent with the principles and novel features disclosed herein.

Claims

1. A method for remote operation control of an excavator, characterized in that, Applied to a master miniature excavator, the method includes: The original joint angles of the operating mechanism of the main-end miniature excavator are acquired in real time. Based on the device identifier of the target slave excavator connected to the master miniature excavator, a pre-calibrated device profile parameter package corresponding to the target slave excavator is obtained; wherein, the device profile parameters include at least: joint angle mapping function and control mode of the target slave excavator; Based on the joint angle mapping function corresponding to the target excavator, the original joint angle is converted into the target joint angle; Based on the control mode of the target slave excavator and the target joint angle, a first control command executable by the target slave excavator is generated and sent to the target slave excavator to control the target slave excavator to perform actions corresponding to the operating mechanism posture of the master miniature excavator.

2. The method according to claim 1, characterized in that, The control modes include: joint angle closed-loop control mode, stroke closed-loop control mode, or drive quantity closed-loop control mode; the step of generating a first control command executable by the target slave excavator based on the target joint angle according to the control mode of the target slave excavator includes: The control mode of the target slave excavator is the joint angle closed-loop control mode, which directly generates joint angle control commands based on the target joint angle; When the control mode of the target slave excavator is the stroke closed-loop control mode, the target joint angle is converted into the corresponding stroke based on the kinematics of the slave link of the target slave excavator, and a stroke control command is generated based on the corresponding stroke. When the control mode of the target slave excavator is the drive quantity closed-loop control mode, the feedback joint angle of the target slave excavator is obtained, and the angle error between the feedback joint angle and the target joint angle is calculated; based on the angle error, the corresponding drive quantity is generated through the closed-loop control algorithm, and a drive quantity control command is generated based on the corresponding drive quantity.

3. The method according to claim 1, characterized in that, The step of converting the original joint angle into the target joint angle according to the joint angle mapping function corresponding to the target slave excavator includes: Based on the device profile parameter package, at least one of the following is performed on the original joint angle: zero-position compensation, direction correction, digital filtering, dead zone elimination, and telescopic structure compensation, to obtain the preprocessed original joint angle; Based on the joint angle mapping function corresponding to the target excavator, the preprocessed raw joint angles are converted into target joint angles.

4. The method according to claim 1, characterized in that, After generating a first control command executable by the target slave excavator based on the target joint angle according to the control mode of the target slave excavator, the method further includes: The first control command is subjected to a safety protection verification to obtain a safety protection verification result; wherein, the safety protection verification includes: soft limit verification, motion rate limit verification, workspace interference verification, and communication feedback anomaly verification; The sending to the target slave excavator includes: When the security protection verification result is successful, the first control command is sent to the target slave excavator.

5. The method according to claim 4, characterized in that, The method further includes: When the safety protection verification result is that the verification fails, the system will perform a mid-position hold, controlled deceleration shutdown, or degraded operation. The mid-position holding is the generation of a mid-position control command that stops the operation of each actuator of the target slave excavator, so that the target slave excavator maintains its current posture or stops operating. The controlled deceleration shutdown is achieved by controlling the actuators of the target excavator to decelerate to a stop according to a preset deceleration rate. The degraded operation restricts the target excavator's speed, range of motion, or available joints.

6. The method according to claim 1, characterized in that, The equipment profile parameter package also includes: master-slave joint zero position, positive angle definition, joint motion limits, safety margin, link geometry, stroke range, speed threshold, acceleration threshold, and hydraulic dead zone.

7. The method according to claim 6, characterized in that, The pre-calibrated equipment profile parameter package corresponding to the target slave excavator is obtained in the following way: Obtain the device identifier of the target slave excavator; Adjust the master-end miniature excavator and the target slave-end excavator to a unified reference zero position, record the master-end joint zero position and the slave-end reference joint angle, and obtain the master-slave joint zero position; Drive each joint of the master miniature excavator and the target slave excavator to move in the forward and reverse directions to the boundary of the allowable range, collect the corresponding angle or stroke, and determine the positive angle direction, maximum range of motion, minimum range of motion and hardware safety boundary of each joint. The slave attitude feedback angle is collected according to the feedback form of the target slave excavator: if joint angle feedback is available, the real-time joint angle of the slave end is collected as the slave attitude feedback angle; if only cylinder or push rod stroke feedback is available, the stroke data is collected and converted into equivalent joint angles according to the linkage geometry as the slave attitude feedback angle; if there is no complete feedback, multiple sets of artificial feature posture points are collected as the slave attitude feedback angle. Based on the multiple sets of corresponding master joint angles and slave posture feedback angles obtained from the acquisition, a joint angle mapping function is fitted. Based on the active joint zero position, the positive angle direction, the maximum range of motion, the minimum range of motion, the hardware safety boundary, and the joint angle mapping function, as well as the linkage geometry, stroke range, speed threshold, acceleration threshold, and hydraulic dead zone of the target slave excavator itself, the equipment profile parameter package corresponding to the target slave excavator is obtained.

8. The method according to claim 1, characterized in that, The method further includes: In response to a movement operation of the operating mechanism of the main-end miniature excavator, the original stroke of the operating mechanism of the main-end miniature excavator is acquired in real time; wherein, the original stroke is the linear motion stroke of the operating mechanism; Based on the device identifier of the target slave excavator connected to the master miniature excavator, obtain the stroke mapping function corresponding to the target slave excavator, and convert the original stroke amount into the target stroke amount based on the stroke mapping function; Based on the target travel distance, a second control command executable by the target slave excavator is generated and sent to the target slave excavator to control the target slave excavator to perform an action corresponding to the movement of the operating mechanism of the master miniature excavator; During the process of the target slave excavator performing an action corresponding to the stroke of the operating mechanism of the master miniature excavator, the actual stroke of the actuator of the target slave excavator is acquired in real time; Based on the target stroke and the actual stroke, the stroke error is obtained, and the second control command is compensated in real time according to the stroke error.

9. The method according to claim 8, characterized in that, The travel mapping function includes at least one of the following: a linear mapping function, a piecewise nonlinear mapping function, and a multi-point calibration mapping function.

10. A remote control device for an excavator, characterized in that, Applied to a main-end miniature excavator, the device includes: The joint angle acquisition module is used to acquire the original joint angles of the operating mechanism of the main end miniature excavator in real time; The parameter package acquisition module is used to acquire a pre-calibrated equipment profile parameter package corresponding to the target slave excavator based on the equipment identifier of the target slave excavator connected to the master miniature excavator; wherein, the equipment profile parameters include at least: joint angle mapping function and control mode of the target slave excavator; The joint angle conversion module is used to convert the original joint angle into the target joint angle according to the joint angle mapping function corresponding to the target slave excavator; The instruction generation module is used to generate a first control instruction executable by the target slave excavator based on the target joint angle according to the control mode of the target slave excavator, and send it to the target slave excavator to control the target slave excavator to perform an action corresponding to the posture of the operating mechanism of the master miniature excavator.