Legged-tracked composite mobile robot driving and controlling system and method
By designing a foot-style composite mobile robot drive control system, using sensors to collect obstacle information and generate appropriate driving instructions, and automatically switch foot-style and foot-style movement methods, the problem of poor flexibility in the existing technology is solved and the robot is improved Adaptability in complex environments.
Patent Information
- Application Number
- PCT/CN2023/137607
- Authority / Receiving Office
- WO · WO
- Patent Type
- Applications
- Current Assignee / Owner
- Priority Date
- 2023-05-30
- Filing Date
- 2023-12-08
- Publication Date
- 2024-12-05
AI Technical Summary
The existing robot control system cannot be adapted to foot-style composite mobile robots, resulting in poor flexibility in complex environments and the inability to automatically switch foot-style and foot-style mobile methods.
A foot-style composite mobile robot drive control system is designed, using information collection sensors to collect obstacle dimension information, compare and preset safety thresholds through the upper computer, generate gait or track drive commands, and automatically switch foot-style and foot-style The movement mode of the drive mechanism.
Automatic switching of foot-style composite mobile robot movement mode in complex environments enhances adaptability to complex environments and improves flexibility.
Smart Images

Figure CN2023137607_05122024_PF_FP_ABST
Abstract
Description
Drive and control system and method for foot-type composite mobile robot Technical Field
[0001] The present application relates to the field of robotics technology, and in particular to a driving and controlling system and method for a foot-type composite mobile robot. Background Art
[0002] Mobile robots, a key branch of robotics, have garnered widespread attention and application in recent years in scenarios such as disaster relief, industrial manufacturing, military operations, and space exploration, demonstrating broad market prospects and application value. Based on their locomotion mode, mobile robots can be categorized as wheeled, tracked, legged, hybrid, and crawling robots. In complex working environments, leveraging biomimetic principles, legged robots possess greater adaptability than other types of robots, enabling them to navigate larger obstacles within their overall dimensions. Tracked robots, on the other hand, offer strong traction, resistance to slippage, and excellent off-road performance, resulting in robust surface adaptability. Currently, most mobile robots on the market are either wheeled or tracked, with relatively limited locomotion modes. Consequently, existing control systems are limited to controlling only one locomotion mode. Applying both legged and tracked control systems to combined foot-and-crawler mobile robots requires manual switching between control modes, resulting in limited flexibility and inability to meet the operational requirements of these robots in complex environments. Technical issues
[0003] In view of this, the present application provides a driving and controlling system and method for a foot-type composite mobile robot to solve the problem that existing robot control systems are not suitable for foot-type mobile robots. Technical Solutions
[0004] In order to solve the above technical problems, a technical solution adopted in the present application is: to provide a foot-and-track composite mobile robot drive and control system, which is applied to the foot-and-track composite mobile robot, the composite mobile robot includes a foot drive mechanism and a track drive mechanism; the drive and control system includes: an information acquisition sensor, used to collect obstacle size information of a pre-designated activity area; a host computer, electrically connected to the information acquisition sensor, used to receive the obstacle size transmitted by the information acquisition sensor, and compare the obstacle size with a preset safety threshold to confirm whether to execute an obstacle crossing strategy or an obstacle avoiding strategy, when executing the obstacle crossing strategy, generating a gait control instruction according to the obstacle size information, when executing the obstacle avoiding strategy, generating a track drive instruction according to the obstacle size information; a foot drive subsystem, electrically connected to the host computer, used to receive the gait control instruction sent by the host computer, and control the movement of the foot drive mechanism according to the gait control instruction; a track drive subsystem, electrically connected to the host computer, used to receive the track drive instruction sent by the host computer, and control the movement of the track drive mechanism according to the track drive instruction.
[0005] As a further improvement of the present application, the foot-type drive subsystem includes: a hydraulic cylinder control module and a displacement sensor, the hydraulic cylinder control module is electrically connected to the host computer and the displacement sensor respectively; the displacement sensor is used to collect the actual position of the hydraulic cylinder and feed back the actual position to the hydraulic cylinder control module; the hydraulic cylinder control module is used to drive the hydraulic cylinder to work according to the gait control instructions and actual position issued by the host computer.
[0006] As a further improvement of the present application, the hydraulic cylinder control module includes: a multi-axis motion controller, an amplifier and a proportional valve. The multi-axis motion controller is electrically connected to the host computer and the amplifier, and the amplifier is electrically connected to the proportional valve; the multi-axis motion controller is used to generate an analog voltage based on the error between the target position and the actual position; the amplifier is used to amplify the analog voltage and convert it into a control electrical signal for the proportional valve; the proportional valve is used to control the valve opening according to the control electrical signal to control the stroke and speed of the extension and retraction of the hydraulic rod of the hydraulic cylinder.
[0007] As a further improvement of the present application, the crawler drive subsystem includes: a track controller, a left track drive motor and a right track drive motor, the track controller being respectively connected to the host computer, the left track drive motor and the right track drive motor by telecommunications; the track controller being used to generate a left track drive signal and / or a right track drive signal according to the track drive instruction issued by the host computer; the left track drive motor being used to drive the left track to move according to the left track drive signal; and the right track drive motor being used to drive the right track to move according to the right track drive signal.
[0008] As a further improvement of the present application, the crawler drive subsystem also includes a remote controller, which is communicatively connected to the crawler controller.
[0009] In order to solve the above technical problems, another technical solution adopted in the present application is: to provide a foot-and-shoe composite mobile robot driving and controlling method, which is applied to any of the above-mentioned foot-and-shoe composite mobile robot driving and controlling systems, and the foot-and-shoe composite mobile robot driving and controlling system includes: an information acquisition sensor, a host computer, a foot-type driving subsystem, and a shoe-type driving subsystem; the method includes: the information acquisition sensor acquires obstacle size information of a pre-specified activity area; the host computer receives the obstacle size information transmitted by the information acquisition sensor, and compares the obstacle size with the size of a preset safety threshold, and the preset safety threshold is based on the rotation angle information of each leg joint of the foot driving mechanism and the foot end The position information and motion space information of the current posture are set; when the obstacle size does not exceed the preset safety threshold, the upper computer executes the obstacle crossing strategy, generates gait control instructions according to the obstacle size information and sends them to the foot drive subsystem; the foot drive subsystem receives the gait control instructions sent by the upper computer, and controls the movement of the foot drive mechanism according to the gait control instructions; when the obstacle size exceeds the preset safety threshold, the upper computer executes the obstacle avoidance strategy, generates track drive instructions according to the obstacle size information and sends them to the track drive subsystem; the track drive subsystem receives the track drive instructions sent by the upper computer, and controls the movement of the track drive mechanism according to the track drive instructions.
[0010] As a further improvement of the present application, the foot-type drive subsystem includes: a hydraulic cylinder control module and a displacement sensor; the foot-type drive subsystem receives gait control instructions sent by the upper computer, and controls the movement of the foot-type drive mechanism according to the gait control instructions, including: the displacement sensor collects the actual position of the hydraulic cylinder and feeds back the actual position to the hydraulic cylinder control module; the hydraulic cylinder control module drives the hydraulic cylinder to work according to the gait control instructions and actual position sent by the upper computer.
[0011] As a further improvement of the present application, the hydraulic cylinder control module includes: a multi-axis motion controller, an amplifier and a proportional valve; the hydraulic cylinder control module drives the hydraulic cylinder to work according to the gait control instructions and actual position issued by the upper computer, including: the multi-axis motion controller generates an analog voltage according to the error between the target position and the actual position; the amplifier amplifies the analog voltage and converts it into a control electrical signal of the proportional valve; the proportional valve controls the valve opening according to the control electrical signal to control the stroke and speed of the extension and retraction of the hydraulic rod of the hydraulic cylinder.
[0012] As a further improvement of the present application, the crawler drive subsystem includes: a track controller, a left track drive motor and a right track drive motor; the crawler drive subsystem receives the track drive instructions sent by the upper computer, and controls the movement of the crawler drive mechanism according to the track drive instructions, including: the track controller generates a left track drive signal and / or a right track drive signal according to the track drive instructions sent by the upper computer; the left track drive motor drives the left track to move according to the left track drive signal; and the right track drive motor drives the right track to move according to the right track drive signal.
[0013] As a further improvement of the present application, the track drive subsystem also includes a remote control; the method also includes: the track controller receives the left track drive instruction and / or the right track drive instruction issued by the remote control, and generates a left track drive signal and / or a right track drive signal according to the left track drive instruction and / or the right track drive instruction. Beneficial effects
[0014] The beneficial effects of the present application are as follows: the drive control system of the foot-and-track composite mobile robot of the present application uses information collection sensors to collect obstacle size information of obstacles on the mobile robot's moving path, and then uses a host computer to compare the obstacle size information with a preset safety threshold to determine whether to execute an obstacle crossing strategy or an obstacle avoidance strategy. When executing the obstacle crossing strategy, the host computer generates a gait control instruction based on the obstacle size information and sends it to the foot drive subsystem, and the foot drive subsystem controls the movement of the foot drive mechanism according to the less control instruction; when executing the obstacle avoidance strategy, the host computer generates a crawler drive instruction based on the obstacle size information and sends it to the crawler drive subsystem, and the crawler drive subsystem controls the movement of the crawler drive mechanism according to the crawler drive instruction. By adopting the appropriate "obstacle crossing" or "obstacle avoidance" strategy according to the size of the obstacle, the foot-and-track composite mobile robot can automatically switch between the foot-and-track movement mode and the crawler movement mode in complex environments, thereby enhancing the adaptability to complex environments and improving the flexibility of the foot-and-track composite mobile robot. BRIEF DESCRIPTION OF THE DRAWINGS
[0015] 1 is a schematic structural diagram of a foot-type composite mobile robot according to an embodiment of the present invention;
[0016] 2 is a schematic structural diagram of a drive and control system for a foot-type composite mobile robot according to an embodiment of the present invention;
[0017] 3 is a finite state machine of the foot-and-shoe state switching of the foot-and-shoe composite mobile robot drive control system according to an embodiment of the present invention;
[0018] 4 is a schematic structural diagram of a foot-type drive subsystem of a drive and control system for a foot-type composite mobile robot according to an embodiment of the present invention;
[0019] 5 is a schematic structural diagram of a track-type drive subsystem of a drive and control system for a foot-type composite mobile robot according to an embodiment of the present invention;
[0020] FIG6 is a flow chart of a method for driving and controlling a foot-type composite mobile robot according to an embodiment of the present invention. Best Mode for Carrying Out the Invention
[0021] The following will be combined with the drawings in the embodiments of this application to clearly and completely describe the technical solutions in the embodiments of this application. Obviously, the embodiments described are only part of the embodiments of this application, not all of the embodiments. Based on the embodiments in this application, all other embodiments obtained by ordinary technicians in this field without making creative efforts are within the scope of protection of this application.
[0022] The terms "first," "second," and "third" in this application are used for descriptive purposes only and should not be construed as indicating or implying relative importance or implicitly specifying the number of technical features identified. Therefore, features identified as "first," "second," or "third" may explicitly or implicitly include at least one of such features. In the description of this application, "plurality" means at least two, for example, two, three, etc., unless otherwise specifically defined. All directional designations in the embodiments of this application (such as up, down, left, right, front, back, etc.) are intended only to illustrate the relative positional relationships and movement of components in a specific posture (as shown in the accompanying drawings). If the specific posture changes, the directional designations will also change accordingly. Furthermore, the terms "including," "having," and any variations thereof are intended to cover non-exclusive inclusions. For example, a process, method, system, product, or apparatus comprising a series of steps or elements is not limited to the listed steps or elements but may optionally include steps or elements not listed, or may optionally include other steps or elements inherent to such process, method, product, or apparatus.
[0023] References herein to "embodiments" mean that a particular feature, structure, or characteristic described in connection with the embodiments may be included in at least one embodiment of the present application. The appearance of this phrase in various places in the specification does not necessarily refer to the same embodiment, nor does it constitute an independent or alternative embodiment that is mutually exclusive of other embodiments. It is understood, both explicitly and implicitly, by those skilled in the art that the embodiments described herein may be combined with other embodiments.
[0024] The drive and control system for a foot-and-track hybrid mobile robot of this embodiment is applied to a foot-and-track hybrid mobile robot. As shown in Figure 1, the foot-and-track hybrid mobile robot includes a foot drive mechanism 100 and a tracker drive mechanism 200, as well as a platform mechanism 300 connected to the foot drive mechanism 100 and the tracker drive mechanism 200. The foot drive mechanism 100 is disposed on both sides of the platform mechanism 300, and the tracker drive mechanism 200 is disposed at the bottom of the platform mechanism 300. The robot can switch between foot-and-tracker locomotion and tracker locomotion. The foot drive mechanism 100 is hydraulically driven, while the tracker drive mechanism 200 is electrically driven.
[0025] Figure 2 is a schematic diagram of the structure of a drive and control system for a hybrid mobile robot with a foot and a crawler, according to an embodiment of the present invention. As shown in Figure 2, the drive and control system for a hybrid mobile robot with a foot and a crawler comprises an information acquisition sensor 1, a host computer 2, a foot drive subsystem 3, and a crawler drive subsystem 4. The host computer 2 is electrically connected to the information acquisition sensor 1, the foot drive subsystem 3, and the crawler drive subsystem 4.
[0026] Among them, the information acquisition sensor 1 is used to collect obstacle size information in a pre-specified activity area; the host computer 2 is used to receive the obstacle size transmitted by the information acquisition sensor 1, and compare the obstacle size with a preset safety threshold to confirm whether to execute an obstacle crossing strategy or an obstacle avoiding strategy. When executing the obstacle crossing strategy, a gait control instruction is generated according to the obstacle size information; when executing the obstacle avoiding strategy, a track drive instruction is generated according to the obstacle size information; the foot drive subsystem 3 is used to receive the gait control instruction sent by the host computer 2, and control the movement of the foot drive mechanism 100 according to the gait control instruction; the track drive subsystem 4 is used to receive the track drive instruction sent by the host computer 2, and control the movement of the track drive mechanism 200 according to the track drive instruction.
[0027] Specifically, the information acquisition sensor 1 is a sensor such as a camera or radar. The pre-designated activity area is a certain range in the movement direction of the foot-type hybrid mobile robot. The information acquisition sensor 1 collects obstacle information within this area and obtains the obstacle size. The obstacle size is then transmitted to the host computer 2. The host computer 2 compares the obstacle size with a preset safety threshold. If the obstacle size is within the preset safety threshold, the obstacle crossing strategy is executed. If the obstacle size exceeds the preset safety threshold, the obstacle avoidance strategy is executed.
[0028] In this example, the Denavit-Hartenberg (DH) parameter method is used to model and analyze the kinematics of a single leg of a foot-and-track hybrid mobile robot. This method obtains information about the rotation angles of each leg joint, the current position of the foot, and the motion space. By calculating the motion space of the robot's single leg and the track height, the maximum safe height that the foot-and-track hybrid mobile robot can cross is determined. A preset safety threshold is then set based on the motion space and track height. By comparing the obstacle size with the preset safety threshold, either a crossing strategy or an obstacle avoidance strategy is selected.
[0029] In this embodiment, by establishing a finite state machine (FSM) based on a state model, the foot-and-shoe hybrid mobile robot can switch the foot-and-shoe state according to the motion state corresponding to the event. The formal definition of the finite state machine is: , where: Represents a finite set of states within the entire system; represents the input set of the system; Represents the transition function between states in a finite state machine; Represents the initial state of the entire system; Represents the set of system outputs. Transformation function definition: , where: Indicates the current state of the object. character, the object will transition to the state As shown in FIG3 , the state model of the foot-type composite mobile robot in this embodiment is as follows:
[0030] (1) T represents the track state of the mobile robot, H represents the foot state of the mobile robot, Indicates the status of track switching foot type, represents the state of the foot-type switching track, and the finite state set Q is expressed as follows: ;
[0031] (2) Input events are stop switching, start switching, and switching completion. The input event set S is expressed as follows: ;
[0032] (3) After a certain condition is triggered, the mobile robot transitions from the current state to the next state. The state transition function F is expressed as: ;
[0033] (4) The initial state of the foot-and-shoe hybrid mobile robot is to use the tracks as the movement mode, so the initial state ;
[0034] (5) The output set Z is the corresponding motion state output by the robot's input event.
[0035] When it detects that an unknown obstacle in front meets the "crossing" requirement of the mobile robot, the robot will cross the obstacle in a foot-type motion mode. At this time, the mobile robot will change from the track state to the Convert to crawler-style switching state ; When switching state After completion, the current state of the mobile robot is the foot-type state H, and it crosses the obstacle in the foot-type motion state; when the robot has completed the obstacle, the robot needs to switch back to the track motion mode to continue to quickly follow the path. At this time, the mobile robot switches from the foot-type state H to the foot-type switching track state ; When switching state After completion, the current state of the mobile robot is the track state T. When it is detected that the unknown obstacle ahead does not meet the "crossing" requirement of the mobile robot, the current state of the mobile robot remains unchanged and another path is planned to bypass the obstacle.
[0036] Preferably, the host computer 2 is also provided with an industrial control touch screen to facilitate the user to input control instructions to the mobile robot through the industrial control touch screen. In addition, the host computer 2 can also realize 5G communication with the remote host device to receive the control instructions sent by the user through the remote host device, facilitating the user to remotely control the mobile robot in real time.
[0037] The control system for a foot-and-foot hybrid mobile robot of this embodiment utilizes an information acquisition sensor 1 to collect obstacle size information of obstacles in the mobile robot's path. The host computer 2 then compares the obstacle size information with a preset safety threshold to determine whether to execute an obstacle-crossing strategy or an obstacle-avoiding strategy. When executing an obstacle-crossing strategy, the host computer 2 generates a gait control instruction based on the obstacle size information and sends it to the foot-and-foot drive subsystem 3. The foot-and-foot drive subsystem 3 controls the movement of the foot-and-foot drive mechanism 100 according to the gait control instruction. When executing an obstacle-avoiding strategy, the host computer 2 generates a track drive instruction based on the obstacle size information and sends it to the track drive subsystem 4. The track drive subsystem 4 controls the movement of the track drive mechanism 200 according to the track drive instruction. By adopting the appropriate "obstacle-crossing" or "obstacle-avoiding" strategy based on the size of the obstacle, the robot can automatically switch between foot-and-foot locomotion and track-and-foot locomotion modes in complex environments, enhancing its adaptability to complex environments and improving its flexibility.
[0038] Furthermore, as shown in Figure 4, the foot-type drive subsystem 3 includes a hydraulic cylinder control module 31 and a displacement sensor 32. The hydraulic cylinder control module 31 is electrically connected to the host computer 2 and the displacement sensor 32, respectively. The displacement sensor 32 is used to collect the actual position of the hydraulic cylinder and feed it back to the hydraulic cylinder control module 31. The hydraulic cylinder control module 31 is used to drive the hydraulic cylinder according to the gait control instructions issued by the host computer 2 and the actual position.
[0039] Specifically, this embodiment adopts PID (proportional-integral-differential) closed-loop control. The hydraulic cylinder control module 31 calculates the error based on the gait control instructions issued by the host computer 2 and the actual position feedback from the displacement sensor 32, and then generates a corresponding electrical signal based on the error to drive the hydraulic cylinder to work.
[0040] Furthermore, as shown in Figure 4, the hydraulic cylinder control module 31 includes a multi-axis motion controller 311, an amplifier 312, and a proportional valve 313. The multi-axis motion controller 311 is electrically connected to the host computer 2 and the amplifier 312, respectively. The amplifier 312 is electrically connected to the proportional valve 313. The multi-axis motion controller 311 is used to generate an analog voltage based on the error between the target position and the actual position; the amplifier 312 is used to amplify the analog voltage and convert it into a control signal for the proportional valve 313; the proportional valve 313 is used to control the valve opening according to the control signal, thereby controlling the stroke and speed of the hydraulic cylinder's hydraulic rod extension.
[0041] Specifically, when the hydraulic cylinder is working, the actual position fed back by the displacement sensor 32 is compared with the target position, and the error is transmitted to the multi-axis motion controller 311, and the target position is obtained from the gait control instruction. The multi-axis motion controller 311 performs digital-to-analog signal conversion on the error between the target position and the actual position, and then outputs the analog voltage to the amplifier board based on the information after the digital-to-analog signal conversion. The amplifier board amplifies the analog voltage and converts it into a control electrical signal for the proportional valve 313. The proportional valve 313 controls the valve opening according to the control electrical signal to control the flow and pressure of each hydraulic oil circuit, and then controls the stroke and speed of the hydraulic rod extension. The displacement sensor 32 collects the actual position of the hydraulic cylinder, and converts the actual position into an analog-to-digital signal, and then feeds back the actual position after the analog-to-digital signal conversion, and transmits it to the comparator to realize closed-loop control.
[0042] It should be noted that in this embodiment, the foot drive mechanism 100 is preferably a hexapod structure, each bionic foot having three joints, each of which is driven by a hydraulic cylinder to achieve three degrees of freedom of movement. Therefore, the foot drive mechanism 100 requires 18 hydraulic cylinders to drive, corresponding to 18 multi-axis motion controllers 311, each of which controls the movement of a hydraulic cylinder. The foot drive subsystem 3 performs gait planning on the hexapod's movement through the host computer 2 to generate gait control instructions, and then the foot drive subsystem 3 performs linkage control on the hexapod according to the gait control instructions. Among them, the foot drive subsystem 3 performs task processing based on a multi-threaded approach to achieve synchronous control of the hexapod.
[0043] Furthermore, as shown in FIG5 , the crawler drive subsystem 4 includes a crawler controller 41, a left crawler drive motor 42, and a right crawler drive motor 43. The crawler controller 41 is electrically connected to the host computer 2, the left crawler drive motor 42, and the right crawler drive motor 43. The crawler controller 41 is configured to generate a left crawler drive signal and / or a right crawler drive signal based on the crawler drive instructions issued by the host computer 2; the left crawler drive motor 42 is configured to drive the left crawler according to the left crawler drive signal; and the right crawler drive motor 43 is configured to drive the right crawler according to the right crawler drive signal.
[0044] It should be noted that the crawler drive subsystem 4 and the host computer 2 use RS485 serial communication to exchange data.
[0045] Furthermore, the crawler drive subsystem 4 also includes a remote controller 44 , which is in communication with the crawler controller 41 .
[0046] Specifically, the crawler drive subsystem 4 provides a remote interactive interface to achieve communication connection with the remote controller 44 , and the user can directly control the operation of the crawler drive subsystem 4 through the remote controller 44 .
[0047] Figure 6 is a flow chart of a method for driving and controlling a foot-and-shoe composite mobile robot according to an embodiment of the present invention. The method is applied to the foot-and-shoe composite mobile robot driving and controlling system described in the above embodiment. The foot-and-shoe composite mobile robot driving and controlling system includes: an information acquisition sensor, a host computer, a foot drive subsystem, and a shoe drive subsystem. The method for driving and controlling a foot-and-shoe composite mobile robot includes:
[0048] Step S101: The information collection sensor collects obstacle size information in a pre-specified activity area.
[0049] Step S102: The host computer receives obstacle size information transmitted by the information collection sensor and compares the obstacle size with a preset safety threshold. The preset safety threshold is set based on the leg joint angle information of the foot drive mechanism, the current position information of the foot end, and the motion space information. If the obstacle size does not exceed the preset safety threshold, steps S103 and S104 are executed; if the obstacle size exceeds the preset safety threshold, steps S105 and S106 are executed.
[0050] Step S103: The host computer executes the obstacle crossing strategy, generates gait control instructions according to the obstacle size information, and sends them to the foot-type drive subsystem.
[0051] Step S104: the foot-type drive subsystem receives the gait control instruction sent by the host computer, and controls the movement of the foot-type drive mechanism according to the gait control instruction.
[0052] Step S105: The host computer executes the obstacle avoidance strategy, generates a crawler drive instruction according to the obstacle size information, and sends it to the crawler drive subsystem.
[0053] Step S106: The crawler drive subsystem receives the crawler drive instruction sent by the host computer, and controls the movement of the crawler drive mechanism according to the crawler drive instruction.
[0054] Furthermore, the foot-type drive subsystem includes: a hydraulic cylinder control module and a displacement sensor. Step S104 specifically includes:
[0055] 1. The displacement sensor collects the actual position of the hydraulic cylinder and feeds the actual position back to the hydraulic cylinder control module.
[0056] 2. The hydraulic cylinder control module drives the hydraulic cylinder to work according to the gait control instructions and actual position issued by the host computer.
[0057] Furthermore, the hydraulic cylinder control module includes: a multi-axis motion controller, an amplifier and a proportional valve. The hydraulic cylinder control module drives the hydraulic cylinder to work according to the gait control instructions and actual position issued by the host computer, specifically including:
[0058] 2.1. The multi-axis motion controller generates an analog voltage based on the error between the target position and the actual position.
[0059] 2.2. The amplifier amplifies the analog voltage and converts it into a control electrical signal for the proportional valve.
[0060] 2.3. The proportional valve controls the valve opening according to the control electrical signal to control the stroke and speed of the hydraulic rod of the hydraulic cylinder.
[0061] Furthermore, the crawler drive subsystem includes: a crawler controller, a left crawler drive motor and a right crawler drive motor. Step S106 specifically includes:
[0062] 1. The track controller generates a left track drive signal and / or a right track drive signal according to the track drive command issued by the host computer.
[0063] 2. The left track drive motor drives the left track to move according to the left track drive signal.
[0064] 3. The right track drive motor drives the right track to move according to the right track drive signal.
[0065] Furthermore, the track drive subsystem also includes a remote control; the driving and controlling method of the foot-track composite mobile robot also includes: the track controller receives the left track drive instruction and / or the right track drive instruction issued by the remote control, and generates a left track drive signal and / or a right track drive signal according to the left track drive instruction and / or the right track drive instruction.
[0066] The control method for a foot-and-track hybrid mobile robot of this embodiment utilizes information acquisition sensors to collect obstacle size information of obstacles in the robot's path. A host computer then compares the obstacle size information with a preset safety threshold to determine whether to execute an obstacle-crossing strategy or an obstacle-avoidance strategy. When executing an obstacle-crossing strategy, the host computer generates gait control instructions based on the obstacle size information and sends them to the foot-and-track drive subsystem, which then controls the movement of the foot-and-track drive mechanism based on the gait control instructions. When executing an obstacle-avoidance strategy, the host computer generates track drive instructions based on the obstacle size information and sends them to the track drive subsystem, which then controls the movement of the track drive mechanism based on the track drive instructions. By adopting the appropriate "obstacle-crossing" or "obstacle-avoidance" strategy based on the size of the obstacle, the robot can automatically switch between foot-and-track movement mode and track-and-track movement mode in complex environments, enhancing its adaptability to complex environments and improving its flexibility.
[0067] For other details about the technical solutions for implementing each step in the method for driving and controlling a foot-type composite mobile robot in the above embodiment, please refer to the description of the driving and controlling system for a foot-type composite mobile robot in the above embodiment, which will not be repeated here.
[0068] It should be noted that the various embodiments in this specification are described in a progressive manner, and each embodiment focuses on the differences from other embodiments. The same and similar parts between the various embodiments can be referenced to each other.
[0069] The above description is only a preferred specific embodiment of the present invention, but the scope of protection of the present invention is not limited thereto. Any technician familiar with the technical field, within the technical scope disclosed by the present invention, who makes equivalent replacements or changes based on the technical solution and inventive concept of the present invention, should be covered by the scope of protection of the present invention.
Claims
1. A foot-type composite mobile robot drive control system, characterized in that: It is applied to a foot-and-foot composite mobile robot, the foot-and-foot composite mobile robot includes a foot-type driving mechanism and a foot-and-foot driving mechanism; the drive control system includes: An information collection sensor is used to collect obstacle size information in a pre-specified activity area; A host computer, electrically connected to the information acquisition sensor, for receiving the obstacle size transmitted by the information acquisition sensor, and comparing the obstacle size with a preset safety threshold to determine whether to execute an obstacle crossing strategy or an obstacle avoiding strategy, and when executing the obstacle crossing strategy, generating a gait control instruction according to the obstacle size information, and when executing the obstacle avoiding strategy, generating a track driving instruction according to the obstacle size information; A foot-type driving subsystem, electrically connected to the host computer, for receiving a gait control instruction sent by the host computer, and controlling the movement of the foot-type driving mechanism according to the gait control instruction; The crawler drive subsystem is electrically connected to the host computer and is used to receive the crawler drive instructions sent by the host computer and control the movement of the crawler drive mechanism according to the crawler drive instructions.
2. The driving and controlling system of a foot-type composite mobile robot according to claim 1, characterized in that: The foot-type driving subsystem includes: a hydraulic cylinder control module and a displacement sensor, wherein the hydraulic cylinder control module is electrically connected to the host computer and the displacement sensor respectively; The displacement sensor is used to collect the actual position of the hydraulic cylinder and feed the actual position back to the hydraulic cylinder control module; The hydraulic cylinder control module is used to drive the hydraulic cylinder to work according to the gait control instruction issued by the host computer and the actual position.
3. The driving and controlling system of a foot-type composite mobile robot according to claim 2, characterized in that: The hydraulic cylinder control module includes: a multi-axis motion controller, an amplifier and a proportional valve, wherein the multi-axis motion controller is electrically connected to the host computer and the amplifier respectively, and the amplifier is electrically connected to the proportional valve; The multi-axis motion controller is used to generate an analog voltage according to the error between the target position and the actual position; The amplifier is used to amplify the analog voltage and convert it into a control electrical signal for the proportional valve; The proportional valve is used to control the valve opening according to the control electrical signal to control the stroke and speed of the hydraulic rod of the hydraulic cylinder.
4. The driving and controlling system of a foot-type composite mobile robot according to claim 1, characterized in that: The crawler drive subsystem includes: a crawler controller, a left crawler drive motor and a right crawler drive motor, wherein the crawler controller is respectively connected to the host computer, the left crawler drive motor and the right crawler drive motor by telecommunication; The track controller is used to generate a left track drive signal and / or a right track drive signal according to the track drive instruction issued by the host computer; The left crawler track driving motor is used to drive the left crawler track to move according to the left crawler track driving signal; The right track driving motor is used to drive the right track to move according to the right track driving signal.
5. The driving and controlling system of a foot-type composite mobile robot according to claim 4, characterized in that: The crawler drive subsystem also includes a remote controller, which is communicatively connected with the crawler controller.
6. A method for driving and controlling a foot-type composite mobile robot, characterized in that: It is applied to the foot-and-foot composite mobile robot drive control system according to any one of claims 1 to 5, wherein the foot-and-foot composite mobile robot drive control system comprises: an information acquisition sensor, a host computer, a foot-type drive subsystem, and a foot-and-foot drive subsystem; the method comprises: The information collection sensor collects obstacle size information in a pre-specified activity area; The host computer receives the obstacle size information transmitted by the information acquisition sensor, and compares the obstacle size with a preset safety threshold, wherein the preset safety threshold is set according to the rotation angle information of each joint of the leg of the foot-type driving mechanism, the position information of the foot end in the current posture, and the motion space information; When the obstacle size does not exceed the preset safety threshold, the host computer executes the obstacle crossing strategy, generates a gait control instruction according to the obstacle size information, and sends it to the foot-type drive subsystem; The foot-type driving subsystem receives the gait control instruction sent by the host computer, and controls the movement of the foot-type driving mechanism according to the gait control instruction; When the size of the obstacle exceeds a preset safety threshold, the host computer executes the obstacle avoidance strategy, generates a crawler drive instruction based on the obstacle size information, and sends it to the crawler drive subsystem; The crawler drive subsystem receives the crawler drive instruction sent by the host computer, and controls the movement of the crawler drive mechanism according to the crawler drive instruction.
7. The driving and controlling method of a foot-type composite mobile robot according to claim 6, characterized in that: The foot-type driving subsystem includes: a hydraulic cylinder control module and a displacement sensor; the foot-type driving subsystem receives a gait control instruction sent by the host computer, and controls the movement of the foot-type driving mechanism according to the gait control instruction, including: The displacement sensor collects the actual position of the hydraulic cylinder and feeds the actual position back to the hydraulic cylinder control module; The hydraulic cylinder control module drives the hydraulic cylinder to work according to the gait control instruction issued by the host computer and the actual position.
8. The driving and controlling method of a foot-type composite mobile robot according to claim 7, characterized in that: The hydraulic cylinder control module includes: a multi-axis motion controller, an amplifier and a proportional valve; the hydraulic cylinder control module drives the hydraulic cylinder to work according to the gait control instruction issued by the host computer and the actual position, including: The multi-axis motion controller generates an analog voltage according to an error between a target position and the actual position; The amplifier amplifies the analog voltage and converts it into a control electrical signal for the proportional valve; The proportional valve controls the valve port opening according to the control electrical signal to control the stroke and speed of the hydraulic rod of the hydraulic cylinder.
9. The driving and controlling method of a foot-type composite mobile robot according to claim 6, characterized in that: The crawler drive subsystem includes: a crawler controller, a left crawler drive motor and a right crawler drive motor; the crawler drive subsystem receives the crawler drive command sent by the host computer, and controls the movement of the crawler drive mechanism according to the crawler drive command, including: The track controller generates a left track drive signal and / or a right track drive signal according to the track drive instruction issued by the host computer; The left crawler track driving motor drives the left crawler track to move according to the left crawler track driving signal; The right crawler track driving motor drives the right crawler track to move according to the right crawler track driving signal.
10. The driving and controlling method of a foot-type composite mobile robot according to claim 9, characterized in that: The crawler drive subsystem further includes a remote controller; the method further includes: The track controller receives the left track drive instruction and / or the right track drive instruction issued by the remote controller, and generates the left track drive signal and / or the right track drive signal according to the left track drive instruction and / or the right track drive instruction.
Citation Information
Patent Citations
Obstacle crossing robot
CN105216899A
Variable-foot type mobile robot
CN111824286A
Foot type multi-mode bionic robot
CN114475831A
Track sufficient combined type mobile robot of leg
CN206654106U
Walking mechanism and bionic search and rescue robot
CN216660086U
