Control method and control system of intelligent mobile terminal and intelligent mobile terminal
By obtaining the position parameters of the intelligent mobile terminal in real time and adjusting its position using the PID control algorithm, the problem that intelligent mobile terminals are difficult to maintain balance in complex road environments is solved, and stable and efficient driving on the road surface is achieved.
Patent Information
- Application Number
- CN202411206761.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-29
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2044-08-29
AI Technical Summary
It is difficult for smart mobile terminals to maintain balance during driving, especially in complex road environments, which affects the working effect of their carrying equipment.
By obtaining the real-time pose parameters of the intelligent mobile terminal in real time, using the PID control algorithm to calculate the pose increment with the contact point on the ground as the zero moment point, and dynamically adjust the pose to maintain a balanced state.
In complex road surface environments, smart mobile terminals can maintain balance, improve their stability and traffic efficiency on the road surface, and ensure the optimal working conditions for the carrying equipment.
Smart Images

Figure CN119024853A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of dynamic balance control of intelligent mobile terminals, and in particular to a control method and control system of an intelligent mobile terminal and an intelligent mobile terminal. Background Art
[0002] In special fields such as disaster relief and medical treatment, where it is difficult for humans to directly participate and smart mobile terminals are needed as assistance, smart mobile terminals, as basic means of transportation, have good performance, which is an important guarantee for completing related rescue and auxiliary tasks. Taking disaster relief as an example, the emergency situation on the scene requires smart mobile terminals to have high timeliness of passage and strong stability of their carrying platforms. In the context of disaster relief, when the road surface is flat and the traffic environment is good, the four-wheel chassis structure can better guarantee the timeliness of the smart mobile terminal under high load conditions. When there are many obstacles on the road and the traffic environment is poor, the two-wheel structure is relatively more flexible. However, no matter what structure the chassis drive mechanism of the smart mobile terminal belongs to, the balance and stability of its carrying platform must be an important prerequisite for completing related tasks.
[0003] Although there are many types of smart mobile terminals and they are widely used, all types of smart mobile terminals are affected by road bumps when driving on the road, making it difficult for the related equipment they carry to work in an ideal environment, thus affecting their operating results.
[0004] Therefore, how to keep the intelligent mobile terminal balanced at all times during its operation becomes an urgent problem to be solved. Summary of the invention
[0005] Based on this, it is necessary to provide a control method, a control system and a smart mobile terminal for the above technical problems, so as to solve the problem that the smart mobile terminal cannot always maintain balance during operation.
[0006] A first aspect of an embodiment of the present application provides a control method for an intelligent mobile terminal, including:
[0007] During the driving process of the smart mobile terminal, real-time position and posture parameters of the smart mobile terminal are obtained in real time;
[0008] Taking the real-time posture parameter as the input of PID control and taking the contact point between the intelligent mobile terminal and the ground as the zero moment point as the target, calculating the posture increment of the real-time posture parameter;
[0009] The posture of the intelligent mobile terminal is dynamically adjusted according to the posture increment, so as to control the intelligent mobile terminal to be in a balanced state during driving.
[0010] The second aspect of an embodiment of the present application provides a control system for an intelligent mobile terminal, comprising: a controller and a balancing module, the controller being connected to the balancing module, the balancing module being used to collect real-time posture parameters of the intelligent mobile terminal and send them to the controller, and adjusting the balance of the intelligent mobile terminal according to the instructions of the controller, and the controller being used to execute the control method of the intelligent mobile terminal described in the first aspect.
[0011] A third aspect of the embodiments of the present application provides an intelligent mobile terminal, which includes the control system of the intelligent mobile terminal according to the second aspect.
[0012] Compared with the prior art, the present invention has the following beneficial effects:
[0013] During the driving process, the smart mobile terminal obtains the real-time posture parameters of the smart mobile terminal in real time, takes the real-time posture parameters as the input of PID control, takes the contact point between the smart mobile terminal and the ground as the zero torque point as the target, calculates the posture increment of the real-time posture parameters, and dynamically adjusts the posture of the smart mobile terminal according to the posture increment to control the smart mobile terminal to be in a balanced state during the driving process. In this application, during the driving process of the smart mobile terminal, the posture parameters of the smart mobile terminal are used as the adjustment target, and the posture parameters of the smart mobile terminal are dynamically adjusted to enable the smart mobile terminal to adapt to complex road environments and maintain a balanced posture to drive stably on the road. BRIEF DESCRIPTION OF THE DRAWINGS
[0014] In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the accompanying drawings required for use in the description of the embodiments of the present invention will be briefly introduced below. Obviously, the accompanying drawings in the following description are only some embodiments of the present invention. For ordinary technicians in this field, other accompanying drawings can be obtained based on these accompanying drawings without paying creative labor.
[0015] Figure 1 It is a flowchart of a control method of an intelligent mobile terminal provided in Embodiment 1 of the present invention;
[0016] Figure 2 is a flow chart of a control method for an intelligent mobile terminal provided in Embodiment 2 of the present invention;
[0017] Figure 3 is a structural block diagram of a control system of an intelligent mobile terminal provided in Embodiment 3 of the present invention;
[0018] Figure 4 is a schematic diagram of the structure of a balancing module provided in Embodiment 4 of the present invention;
[0019] Figure 5This is a schematic diagram of the distribution of inertial navigation sensors in a balancing module in a body provided in a fifth embodiment of the present invention;
[0020] Figure 6 This is a schematic diagram of a four-wheeled bipedal intelligent mobile terminal using four wheels to travel on a flat road or a sloped road provided by Embodiment 6 of the present invention;
[0021] Figure 7 This is a schematic diagram of a four-wheeled bipedal intelligent mobile terminal using two wheels to travel on a flat road or a sloped road provided by Embodiment 7 of the present invention;
[0022] Figure 8 This is a structural block diagram of an intelligent mobile terminal provided in Embodiment 8 of the present invention. DETAILED DESCRIPTION
[0023] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0024] It should be understood that when used in the present specification and the appended claims, the term "comprising" indicates the presence of described features, integers, steps, operations, elements and / or components, but does not exclude the presence or addition of one or more other features, integers, steps, operations, elements, components and / or combinations thereof.
[0025] It should also be understood that the term "and / or" used in the present description and the appended claims refers to and includes any and all possible combinations of one or more of the associated listed items.
[0026] As used in the present specification and the appended claims, the term "if" may be interpreted as "when" or "upon" or "in response to determining" or "in response to detecting", depending on the context. Similarly, the phrase "if it is determined" or "if [described condition or event] is detected" may be interpreted as meaning "upon determination" or "in response to determining" or "upon detection of [described condition or event]" or "in response to detecting [described condition or event]", depending on the context.
[0027] In addition, in the description of the present specification and the appended claims, the terms "first", "second", "third", etc. are only used to distinguish the descriptions and cannot be understood as indicating or implying relative importance.
[0028] References to "one embodiment" or "some embodiments" etc. described in the present specification mean that one or more embodiments of the present invention include specific features, structures or characteristics described in conjunction with the embodiment. Therefore, the statements "in one embodiment", "in some embodiments", "in some other embodiments", "in some other embodiments", etc. that appear in different places in this specification do not necessarily refer to the same embodiment, but mean "one or more but not all embodiments", unless otherwise specifically emphasized in other ways. The terms "including", "comprising", "having" and their variations all mean "including but not limited to", unless otherwise specifically emphasized in other ways.
[0029] It should be understood that the order of execution of the steps in the following embodiments does not imply a precedence of execution. The execution order of each process should be determined by its function and internal logic, and should not constitute any limitation on the implementation process of the embodiments of the present invention.
[0030] In order to illustrate the technical solution of the present invention, the following is described through specific embodiments.
[0031] See also Figure 1 , is a flow chart of a control method for an intelligent mobile terminal provided in Embodiment 1 of the present invention, such as Figure 1 As shown, the control method of the intelligent mobile terminal may include the following steps.
[0032] S101: During the driving process of the smart mobile terminal, real-time position and posture parameters of the smart mobile terminal are obtained in real time.
[0033] In step S101, during the driving process of the smart mobile terminal, the real-time posture parameters of the smart mobile terminal are obtained in real time, wherein the smart mobile terminal may be a four-wheeled and bipedal smart mobile terminal, and the real-time posture parameters include the position of the smart mobile terminal in the axial direction, the position in the radial direction and the position in the tangential direction.
[0034] In this embodiment, the intelligent mobile terminal is a four-wheeled and bipedal intelligent mobile terminal. When the intelligent mobile terminal is traveling on an unknown road environment, the real-time position and posture parameters of the intelligent mobile terminal are obtained in real time. When the real-time position and posture parameters of the intelligent mobile terminal are obtained in real time, they can be obtained through the inertial navigation sensor installed on the intelligent mobile terminal.
[0035] It should be noted that when obtaining the real-time posture parameters of the smart mobile terminal in real time, one inertial navigation sensor can be used for real-time acquisition, or multiple inertial navigation sensors can be used for real-time acquisition. When multiple inertial navigation sensors are used for real-time acquisition, the real-time posture parameters obtained are the average of the real-time posture parameters obtained by the multiple inertial navigation sensors. For example, if three inertial navigation sensors are set on the smart mobile terminal, the average of the real-time posture parameters collected by the three inertial navigation sensors is obtained.
[0036] In this embodiment, the real-time posture parameters of the smart mobile terminal are acquired in real time, so as to adjust the posture of the smart mobile terminal in real time according to the real-time posture parameters, so that the smart mobile terminal is always in a stable state.
[0037] S102: Taking the real-time posture parameters as the input of PID control and the contact point between the intelligent mobile terminal and the ground as the zero torque point as the target, the posture increment of the real-time posture parameters is calculated.
[0038] In step S102, the real-time posture parameters are used as the input of PID control, and the contact point between the intelligent mobile terminal and the ground is taken as the zero torque point as the target, that is, the horizontal force balance of the contact point between the intelligent mobile terminal and the ground is taken as the target, and the posture increment of the real-time posture parameters is calculated, wherein the posture increment of the real-time posture parameters includes the increment in the axial direction, the increment in the radial direction and the increment in the tangential direction.
[0039] In this embodiment, the real-time posture parameter is used as the input of the PID control, and the contact point between the intelligent mobile terminal and the ground is taken as the zero torque point as the target, and the posture increment of the real-time posture parameter is calculated. Among them, the posture increment is the offset in each direction when the intelligent mobile terminal deviates from the equilibrium state. For example, when the posture parameter of the intelligent mobile terminal is the real-time posture parameter, the contact point between the intelligent mobile terminal and the ground is not a zero torque point. Then, the offset in each direction required for the intelligent mobile terminal to reach the zero torque point of the contact point between the intelligent mobile terminal and the ground on the basis of the real-time posture parameter is calculated, that is, the offset in the axial direction, the offset in the radial direction, and the offset in the tangential direction.
[0040] It should be noted that the number of contact points between the smart mobile terminal and the ground is different for different smart mobile terminals. For example, when the smart mobile terminal is a two-wheeled vehicle, the number of contact points between the smart mobile terminal and the ground is two, and when the smart mobile terminal is a four-wheeled vehicle, the number of contact points between the smart mobile terminal and the ground is four. The goal is to make the contact point between the smart mobile terminal and the ground a zero torque point, that is, each contact point between the smart mobile terminal and the ground is a zero torque point.
[0041] It should be noted that when calculating the posture increment of the real-time posture parameters, the posture increment can be zero, that is, the real-time posture parameters of the smart mobile terminal at the current moment can make the contact point between the smart mobile terminal and the ground a zero torque point, that is, the real-time posture parameters at the current moment are the posture parameters when the smart mobile terminal is in a balanced state, and the smart mobile terminal does not need to be adjusted.
[0042] In this embodiment, the real-time posture parameters are used as the input of PID control, and the contact point between the intelligent mobile terminal and the ground is taken as the zero torque point. When the real-time posture parameters are adjusted using the corresponding posture increments, the contact point between the intelligent mobile terminal and the ground can be made a zero torque point when the adjusted posture parameters are used to control the intelligent mobile terminal, thereby allowing the intelligent mobile terminal to drive smoothly.
[0043] S103: Dynamically adjust the posture of the smart mobile terminal according to the posture increment, and control the smart mobile terminal to be in a balanced state during driving.
[0044] In step S103, the posture of the smart mobile terminal is dynamically adjusted according to the posture increment, and the smart mobile terminal is controlled to be in a balanced state during driving. The posture of the smart mobile terminal is dynamically adjusted, that is, the posture of the smart mobile terminal is continuously changed during the driving process of the smart mobile terminal, so that the smart mobile terminal can be in a balanced state at all times.
[0045] In this embodiment, the posture of the smart mobile terminal is dynamically adjusted according to the posture increment, so that the smart mobile terminal is converted from an unbalanced state to a balanced state. The rotation angle of the corresponding motor on the smart mobile terminal can be adjusted, and different rotation angles can be used to change the posture of the smart mobile terminal so that the changed posture is the corresponding posture increment.
[0046] In this embodiment, the posture of the intelligent mobile terminal is dynamically adjusted according to the posture increment, so that when the intelligent mobile terminal is driving based on the adjusted new posture parameters, the contact point between the intelligent mobile terminal and the ground is a zero torque point, thereby reaching a balanced state, ensuring that the intelligent mobile terminal can quickly adapt to the road environment under unknown road conditions, allowing the intelligent mobile terminal to stably travel on the road in a balanced state.
[0047] Optionally, dynamically adjusting the posture of the smart mobile terminal according to the posture increment includes:
[0048] According to the posture increment, the driver is controlled to drive the corresponding joint motor to rotate, so that the change in the posture of the intelligent mobile terminal after the joint motor rotates is equal to the posture increment.
[0049] In this embodiment, according to the posture increment, the driver is controlled to drive the corresponding joint motor to rotate so that the change in the posture of the intelligent mobile terminal after the joint motor rotates is equal to the posture increment, that is, after the driver is controlled to drive the corresponding joint motor to rotate, the adjusted real-time posture parameters of the intelligent mobile terminal are re-collected, the adjusted real-time posture parameters of the intelligent mobile terminal are compared with the real-time posture parameters acquired in real time at the current moment, and the posture difference between the adjusted real-time posture parameters of the intelligent mobile terminal and the real-time posture parameters acquired in real time at the current moment is calculated. If the posture difference is equal to the posture increment, the adjustment is stopped. If the posture difference is not equal to the posture increment, the driver is continued to be controlled to drive the corresponding joint motor to rotate until the posture difference between the adjusted real-time posture parameters and the real-time posture parameters acquired in real time at the current moment is equal to the posture increment, that is, the increment in the axial direction of the adjusted real-time posture parameters is equal to the increment in the axial direction of the posture increment, the increment in the radial direction of the adjusted real-time posture parameters is equal to the increment in the radial direction of the posture increment, and the increment in the tangential direction of the adjusted real-time posture parameters is equal to the increment in the tangential direction of the posture increment.
[0050] During the driving process, the smart mobile terminal obtains the real-time posture parameters of the smart mobile terminal in real time, takes the real-time posture parameters as the input of PID control, takes the contact point between the smart mobile terminal and the ground as the zero torque point as the target, calculates the posture increment of the real-time posture parameters, and dynamically adjusts the posture of the smart mobile terminal according to the posture increment to control the smart mobile terminal to be in a balanced state during the driving process. In this application, during the driving process of the smart mobile terminal, the posture parameters of the smart mobile terminal are used as the adjustment target, and the posture parameters of the smart mobile terminal are dynamically adjusted to enable the smart mobile terminal to adapt to complex road environments and maintain a balanced posture to drive stably on the road.
[0051] See also Figure 2 , is a flow chart of a control method for an intelligent mobile terminal provided in Embodiment 2 of the present invention, such as Figure 2 As shown, the control method of the intelligent mobile terminal may include the following steps.
[0052] S201: When the smart mobile terminal is traveling on a flat road or a sloped road, real-time position parameters of the smart mobile terminal and real-time distance parameters between the smart mobile terminal and the flat road or the sloped road are obtained in real time.
[0053] In step S201, when the smart mobile terminal is traveling on a flat road or a sloped road, the real-time posture parameters of the smart mobile terminal and the real-time distance parameters between the smart mobile terminal and the flat road or the sloped road are obtained in real time. Wherein, the smart mobile terminal may be a four-wheeled and two-legged smart mobile terminal, the real-time posture parameters include the position of the smart mobile terminal in the axial direction, the position in the radial direction and the position in the tangential direction, and the real-time distance parameter between the smart mobile terminal and the flat road or the sloped road is the real-time distance between the body of the smart mobile terminal and the flat road or the sloped road.
[0054] In this embodiment, the smart mobile terminal is a four-wheeled, two-legged smart mobile terminal. When the smart mobile terminal is traveling on a flat road or a sloping road, real-time posture parameters of the smart mobile terminal and real-time distance parameters between the smart mobile terminal and the flat road or the sloping road are obtained in real time. When the real-time posture parameters of the smart mobile terminal are obtained in real time, they can be obtained through the inertial navigation sensor installed on the smart mobile terminal. When the real-time distance parameters between the smart mobile terminal and the flat road or the sloping road are obtained, they can be obtained using the distance sensor installed on the smart mobile terminal.
[0055] It should be noted that when obtaining the real-time posture parameters of the smart mobile terminal in real time, one inertial navigation sensor can be used for real-time acquisition, or multiple inertial navigation sensors can be used for real-time acquisition. When multiple inertial navigation sensors are used for real-time acquisition, the real-time posture parameters obtained are the average of the real-time posture parameters obtained by the multiple inertial navigation sensors. For example, if three inertial navigation sensors are set on the smart mobile terminal, the average of the real-time posture parameters collected by the three inertial navigation sensors is obtained.
[0056] It should be noted that when obtaining the real-time distance parameter between the smart mobile terminal and a flat road or a sloped road, a distance sensor may be set at the bottom of the body to collect the distance between the bottom of the body and the flat road or the sloped road.
[0057] In this embodiment, the real-time posture parameters of the smart mobile terminal and the real-time distance parameters between the smart mobile terminal and the flat road or the sloped road are obtained in real time, so as to adjust the posture of the smart mobile terminal in real time according to the real-time posture parameters, so that the smart mobile terminal is always in a stable state. According to the real-time distance parameters between the smart mobile terminal and the flat road or the sloped road, the distance between the smart mobile terminal and the flat road or the sloped road is adjusted in real time, so that the distance between the smart mobile terminal and the flat road or the sloped road remains unchanged, the stability of the chassis of the smart mobile terminal is increased, and the stability of the chassis is more conducive to keeping the smart mobile terminal in a stable state.
[0058] S202: Taking the real-time posture parameters and the real-time distance parameters as the input of PID control, taking the contact point between the smart mobile terminal and the ground as the zero torque point, and keeping the distance between the smart mobile terminal and the flat road or the slope road unchanged as the goal, calculate the posture increment of the real-time posture parameters and the distance increment of the distance between the smart mobile terminal and the flat road or the slope road.
[0059] In step S202, the real-time posture parameters and the real-time distance parameters are used as inputs of PID control, and the contact point between the intelligent mobile terminal and the ground is set as a zero torque point, and the distance between the intelligent mobile terminal and a flat road or a sloped road is kept unchanged as the goal, wherein the posture increment of the real-time posture parameter includes an increment in the axial direction, an increment in the radial direction, and an increment in the tangential direction, and the distance increment between the intelligent mobile terminal and the flat road or the sloped road is the change in the vertical direction of the intelligent mobile terminal.
[0060] In this embodiment, the real-time posture parameter and the real-time distance parameter are used as the input of PID control, the contact point between the intelligent mobile terminal and the ground is the zero torque point, and the distance between the intelligent mobile terminal and the flat road or the slope road remains unchanged as the goal, and the posture increment of the real-time posture parameter and the distance increment of the distance between the intelligent mobile terminal and the flat road or the slope road are calculated. Among them, the posture increment is the offset in each direction when the intelligent mobile terminal deviates from the horizontal state. For example, when the posture parameter of the intelligent mobile terminal is the real-time posture parameter, the contact point between the intelligent mobile terminal and the ground is not the zero torque point. Then, the offset in each direction required for the intelligent mobile terminal to reach the zero torque point of the contact point between the intelligent mobile terminal and the ground on the basis of the real-time posture parameter is calculated, that is, the offset in the axial direction, the offset in the radial direction, and the offset in the tangential direction. The distance increment is the offset of the center of gravity of the intelligent mobile terminal body.
[0061] It should be noted that the number of contact points between the smart mobile terminal and the ground is different for different smart mobile terminals. For example, when the smart mobile terminal is a two-wheeled vehicle, the number of contact points between the smart mobile terminal and the ground is two, and when the smart mobile terminal is a four-wheeled vehicle, the number of contact points between the smart mobile terminal and the ground is four. The goal is to make the contact point between the smart mobile terminal and the ground a zero torque point, that is, each contact point between the smart mobile terminal and the ground is a zero torque point.
[0062] It should be noted that when calculating the posture increment of the real-time posture parameter, the posture increment can be zero, that is, the real-time posture parameter of the smart mobile terminal at the current moment can make the contact point between the smart mobile terminal and the ground a zero torque point, that is, the real-time posture parameter at the current moment is the posture parameter when the smart mobile terminal is in a balanced state, and the smart mobile terminal does not need to be adjusted. When calculating the distance increment, the distance increment can be zero, that is, the distance parameter of the smart mobile terminal has not changed, and there is no need to adjust the distance between the smart mobile terminal body and the road surface or the slope road surface.
[0063] In this embodiment, the real-time posture parameter is used as the input of PID control, and the contact point between the intelligent mobile terminal and the ground is the zero torque point as the target, so that when the real-time posture parameter is adjusted using the corresponding posture increment, the contact point between the intelligent mobile terminal and the ground can be made the zero torque point when the adjusted posture parameter is used to control the intelligent mobile terminal, so that the intelligent mobile terminal can travel smoothly. The real-time distance parameter is used as the input of PID control, and the distance between the intelligent mobile terminal and the flat road or slope road is kept constant as the target, so that when the real-time distance parameter is adjusted using the corresponding distance increment, the distance between the intelligent mobile terminal body and the road or slope road can be kept constant when the adjusted distance parameter is used to control the intelligent mobile terminal, thereby increasing the stability of the intelligent mobile terminal during driving on a flat road or slope road.
[0064] S203: Dynamically adjust the posture of the smart mobile terminal and the distance between the smart mobile terminal and the flat road or the sloped road according to the posture increment and the distance increment, and control the smart mobile terminal to be in a balanced state during driving on the flat road or the sloped road.
[0065] In step S203, the posture of the smart mobile terminal and the distance between the smart mobile terminal and the flat road or the sloped road are dynamically adjusted according to the posture increment and the distance increment, so that the smart mobile terminal is controlled to be in a balanced state during driving. The posture of the smart mobile terminal and the distance between the flat road or the sloped road are dynamically adjusted, that is, the posture of the smart mobile terminal and the distance between the smart mobile terminal and the flat road or the sloped road are continuously changed during the driving process of the smart mobile terminal, so that the smart mobile terminal can be in a balanced state at all times.
[0066] In this embodiment, the posture of the smart mobile terminal is dynamically adjusted according to the posture increment and the distance increment, wherein the rotation angle of the corresponding motor on the smart mobile terminal can be adjusted, and different rotation angles can be used to change the posture of the smart mobile terminal and the distance between the smart mobile terminal and a flat road or a sloped road, so that the changed posture is the corresponding posture increment, and the distance between the changed smart mobile terminal and the flat road or the sloped road is the distance between the original smart mobile terminal and the flat road or the sloped road.
[0067] In this embodiment, the posture of the intelligent mobile terminal is dynamically adjusted according to the posture increment, so that when the intelligent mobile terminal is driving based on the adjusted new posture parameters, the contact point between the intelligent mobile terminal and the ground is a zero torque point, thereby reaching a balanced state, and according to the distance increment, the distance between the intelligent mobile terminal and the flat road or the sloped road is dynamically adjusted to keep the distance between the intelligent mobile terminal and the flat road or the sloped road unchanged.
[0068] Optionally, dynamically adjusting the posture of the smart mobile terminal and the distance between the smart mobile terminal and a flat road surface or a sloped road surface according to the posture increment and the distance increment includes:
[0069] According to the posture increment and the distance increment, the control driver drives the corresponding joint motor to rotate, so that the change in the posture of the intelligent mobile terminal after the rotation of the joint motor is equal to the posture increment, and the change in the distance between the intelligent mobile terminal and the flat road or slope road after the rotation of the joint motor is equal to the distance increment.
[0070] In this embodiment, according to the posture increment and the distance increment, the control driver drives the corresponding joint motor to rotate, so that the change in the posture of the intelligent mobile terminal after the joint motor rotates is equal to the posture increment, and the change in the distance between the intelligent mobile terminal and the flat road surface or the slope road surface after the joint motor rotates is equal to the distance increment. That is, after the control driver drives the corresponding joint motor to rotate, the adjusted real-time posture parameters of the intelligent mobile terminal and the real-time distance between the intelligent mobile terminal and the flat road surface or the slope road surface are re-collected, the adjusted real-time posture parameters of the intelligent mobile terminal are compared with the real-time posture parameters acquired in real time at the current moment, the posture difference between the adjusted real-time posture parameters of the intelligent mobile terminal and the real-time posture parameters acquired in real time at the current moment is calculated, the adjusted real-time distance parameters of the intelligent mobile terminal are compared with the real-time distance parameters acquired in real time at the current moment, the distance difference between the adjusted real-time distance parameters of the intelligent mobile terminal and the real-time distance parameters acquired in real time at the current moment is calculated, or it is determined whether the adjusted real-time distance parameters are the original distance parameters, wherein the original distance parameters are the distance parameters between the intelligent mobile terminal and the flat road surface or the slope road surface that the intelligent mobile terminal needs to maintain at all times. If the posture difference is equal to the posture increment, the distance difference is equal to the distance increment, or the adjusted real-time distance parameter is the original distance parameter, then the adjustment is stopped; if the posture difference is not equal to the posture increment, or the distance difference is not equal to the distance increment, or the adjusted real-time distance parameter is not the original distance parameter, then the driver is continuously controlled to drive the corresponding joint motor to rotate until the posture difference between the adjusted real-time posture parameter and the real-time posture parameter acquired in real time at the current moment is equal to the posture increment, that is, the increment in the axial direction of the adjusted real-time posture parameter is equal to the increment in the axial direction of the posture increment, the increment in the radial direction of the adjusted real-time posture parameter is equal to the increment in the radial direction of the posture increment, the increment in the tangential direction of the adjusted real-time posture parameter is equal to the increment in the tangential direction of the posture increment, and the distance difference between the adjusted real-time distance parameter and the real-time distance parameter acquired in real time at the current moment is equal to the distance increment, or the adjusted real-time distance parameter is the original distance parameter.
[0071] When the intelligent mobile terminal is traveling on a flat road or a sloping road, the real-time posture parameters of the intelligent mobile terminal and the real-time distance parameters between the intelligent mobile terminal and the flat road or the sloping road are obtained in real time. The real-time posture parameters and the real-time distance parameters are used as inputs of PID control. The contact point between the intelligent mobile terminal and the ground is taken as the zero torque point, and the distance between the intelligent mobile terminal and the flat road or the sloping road remains unchanged as the goal. The posture increment of the real-time posture parameters and the distance increment of the distance between the intelligent mobile terminal and the flat road or the sloping road are calculated. According to the posture increment and the distance increment, the posture of the intelligent mobile terminal and the distance between the intelligent mobile terminal and the flat road or the sloping road are dynamically adjusted to control the intelligent mobile terminal to be in a balanced state during driving on the flat road or the sloping road. In the present application, when the smart mobile terminal is driving on a flat road or a sloping road, the posture parameters of the smart mobile terminal and the distance parameters between the smart mobile terminal and the flat road or the sloping road are used as adjustment targets. By dynamically adjusting the posture parameters of the smart mobile terminal and the distance parameters between the smart mobile terminal and the flat road or the sloping road, the stability of the chassis of the smart mobile terminal is enhanced while maintaining the stability of the body of the smart mobile terminal, thereby further improving the stability of the smart mobile terminal and prolonging the time that the smart mobile terminal maintains a balanced state.
[0072] See also Figure 3 , is a structural block diagram of a control system 30 of an intelligent mobile terminal provided in Embodiment 3 of the present invention. Figure 3 As shown, the control system includes a controller 31 and a balancing module 32. The controller 31 is connected to the balancing module 32. The balancing module 32 is used to collect real-time posture parameters of the intelligent mobile terminal and send them to the controller 31, and adjust the balance of the intelligent mobile terminal according to the instructions of the controller 31. The controller 31 is used to execute the control method of the intelligent mobile terminal in the above-mentioned embodiment one.
[0073] See also Figure 4, is a schematic diagram of the structure of the balancing module 32 provided in the fourth embodiment of the present invention. The balancing module 32 also includes an inertial navigation sensor 321, which is used to collect real-time posture parameters of the intelligent mobile terminal. The balancing module 32 also includes a distance sensor 322, which is used to collect real-time distance parameters between the intelligent mobile terminal and a flat road surface or a sloped road surface. The balancing module 32 also includes a driver 323, which is used to drive the corresponding joint motor to rotate according to the instructions of the controller 31 to adjust the balance of the intelligent mobile terminal. The balancing module 32 also includes a first joint motor 324 arranged on both sides of the body 329, a second joint motor 325 arranged on the chassis connecting rod between the front and rear wheels on the same side, and a third joint motor 326 arranged on each wheel. The second joint motor 325 is fixedly provided with a support connecting rod 327 to connect the body 329. The first joint motor 324 on the same side is connected to the support connecting rod 327 on the second joint motor 325 through an adjustable connecting rod 328. The first joint motor 324 is used to control the body height of the intelligent mobile terminal according to the command of the controller 31, the second joint motor 325 is used to control the angle between the body 329 and the chassis connecting rod according to the command of the controller 31, and the third joint motor 326 is used to drive the intelligent mobile terminal to travel according to the command of the controller 31.
[0074] It should be noted that the inertial navigation sensor 321 in the balancing module 32 may be multiple, for example, three, see Figure 5 , is a schematic diagram of the distribution of the inertial sensors 321 in the body 329 in a balancing module 32 provided in the fifth embodiment of the present invention, wherein the IMU is the inertial sensor 321, the distance between any two inertial sensors 321 is equal, and the posture parameters collected by the three inertial sensors 321 are (x1, y1, z1), (x2, y2, z2), (x3, y3, z3) respectively. The mean of the real-time posture parameters is calculated based on (x1, y1, z1), (x2, y2, z2), (x3, y3, z3), and the mean of the real-time posture parameters is used as the corresponding real-time posture parameters.
[0075] It should be noted that the inertial sensor 321 is arranged in the body of the intelligent mobile terminal, the distance sensor 322 is arranged at the bottom of the body of the intelligent mobile terminal, and the driver 323 is arranged in the body of the intelligent mobile terminal, wherein the number of drivers 323 is equal to the number of corresponding joint motors, and each driver 323 is used to determine the joint motor connected to the corresponding driver 323. Among them, the first joint motor 324 includes two, respectively on both sides of the body, the second joint motor 325 includes two, respectively arranged on the chassis connecting rod 327 between the front and rear wheels on the same side, and the first joint motor and the second joint motor are on the same side, i.e., the left and right sides of the intelligent mobile terminal. The third joint motor 325 includes four, and a third joint motor is arranged in each wheel to drive the wheel to run.
[0076] It should be noted that the controller 31 is used to execute the control method of the intelligent mobile terminal, including: during the driving process of the intelligent mobile terminal, real-time acquisition of the real-time posture parameters of the intelligent mobile terminal, using the real-time posture parameters as the input of PID control, taking the contact point between the intelligent mobile terminal and the ground as the zero torque point as the target, calculating the posture increment of the real-time posture parameters, and dynamically adjusting the posture of the intelligent mobile terminal according to the posture increment, so as to control the intelligent mobile terminal to be in a balanced state during driving.
[0077] A control method for an intelligent mobile terminal, characterized by comprising:
[0078] During the driving process of the smart mobile terminal, the real-time position and posture parameters of the smart mobile terminal are obtained in real time.
[0079] The real-time posture parameter is used as an input of PID control, the contact point between the intelligent mobile terminal and the ground is used as a zero-moment point as a target, and the posture increment of the real-time posture parameter is calculated.
[0080] The posture of the intelligent mobile terminal is dynamically adjusted according to the posture increment, so as to control the intelligent mobile terminal to be in a balanced state during driving.
[0081] The control method of the intelligent mobile terminal also includes:
[0082] When the intelligent mobile terminal is traveling on a flat road or a sloped road, the real-time position and posture parameters of the intelligent mobile terminal and the real-time distance parameters between the intelligent mobile terminal and the flat road or the sloped road are obtained in real time.
[0083] Taking the real-time posture parameters and the real-time distance parameters as the input of PID control, taking the contact point between the intelligent mobile terminal and the ground as the zero moment point and keeping the distance between the intelligent mobile terminal and the flat road or the slope road unchanged as the goal, the posture increment of the real-time posture parameters and the distance increment of the distance between the intelligent mobile terminal and the flat road or the slope road are calculated.
[0084] According to the posture increment and the distance increment, the posture of the intelligent mobile terminal and the distance between the intelligent mobile terminal and the flat road or the sloped road are dynamically adjusted to control the intelligent mobile terminal to be in a balanced state during driving on the flat road or the sloped road.
[0085] According to the posture increment, the posture of the smart mobile terminal is dynamically adjusted, including:
[0086] According to the posture increment, the control driver 323 drives the corresponding joint motor to rotate, so that the change in the posture of the smart mobile terminal after the joint motor rotates is equal to the posture increment. Among them, the driver 323 drives the two first joint motors 324, the two second joint motors 325 and the four third joint motors 326 to rotate.
[0087] According to the posture increment and the distance increment, the posture of the smart mobile terminal and the distance between the smart mobile terminal and the flat road or the sloped road are dynamically adjusted, including:
[0088] According to the posture increment and the distance increment, the driver 323 is controlled to drive the corresponding joint motor to rotate, so that the change in the posture of the intelligent mobile terminal after the joint motor rotates is equal to the posture increment, and the change in the distance between the intelligent mobile terminal and the flat road or the slope road after the joint motor rotates is equal to the distance increment. Among them, the driver 323 drives the two first joint motors 324, the two second joint motors 325 and the four third joint motors 326 to rotate.
[0089] See also Figure 6 , is a schematic diagram of a four-wheeled bipedal intelligent mobile terminal using four wheels to travel on a flat road or a sloped road, provided in Embodiment 6 of the present invention. Figure 6 (a) is a schematic diagram of a four-wheeled bipedal intelligent mobile terminal using four wheels to travel on a flat road. Figure 6 (b) is a schematic diagram of a four-wheeled bipedal intelligent mobile terminal using four wheels to travel on a sloped road.
[0090] It should be noted that when the four-wheeled bipedal intelligent mobile terminal uses four wheels to travel on a flat road or a sloped road, the inertial navigation sensor 321 is used to collect the real-time posture parameters of the four-wheeled bipedal intelligent mobile terminal in real time, and the distance sensor 322 is used to collect the real-time distance parameters between the body and the road in real time. According to the collected real-time posture parameters and real-time distance parameters, the controller 31 controls the driver 323 to drive the first joint motor 324, the first joint motor 324, the second joint motor 325, the third joint motor 326, the fourth joint motor, the fifth joint motor, the sixth joint motor, the seventh joint motor and the eighth joint motor to rotate, so that the intelligent mobile terminal is always in a balanced state.
[0091] It should be noted that when the four-wheeled bipedal intelligent mobile terminal uses four wheels to travel on a flat road or a sloped road, the inertial navigation sensor 321 is used to collect the real-time posture parameters of the four-wheeled bipedal intelligent mobile terminal in real time, and the distance sensor 322 is used to collect the distance between the body and the road in real time. According to the collected real-time posture parameters and real-time distance parameters, the controller 31 controls the driver 323 to drive the corresponding joint motor to rotate.
[0092] See also Figure 7 , is a schematic diagram of a four-wheeled bipedal intelligent mobile terminal using two wheels to travel on a flat road or a sloped road, provided in Embodiment 7 of the present invention. Figure 7 (a) is a schematic diagram of a four-wheeled bipedal intelligent mobile terminal using two wheels to travel on a flat road. Figure 7 (b) is a schematic diagram of a four-wheeled bipedal intelligent mobile terminal using two wheels to travel on a sloped road.
[0093] It should be noted that when the four-wheeled bipedal intelligent mobile terminal uses two wheels to travel on a flat road or a sloped road, two of the wheels are front wheels, that is, the four-wheeled bipedal intelligent mobile terminal lifts the rear wheels and puts the front wheels on the ground. When the rear wheels are lifted and the front wheels are put on the ground, the rear wheels are lifted and the front wheels are put on the ground by controlling the rotation of the second joint motor 325.
[0094] See also Figure 8 , is a structural block diagram of an intelligent mobile terminal 80 provided in Embodiment 8 of the present invention. The intelligent mobile terminal 80 includes a control system 30 of the intelligent mobile terminal. The control system 30 includes a controller 31 and a balancing module 32. The controller 31 is connected to the balancing module 32. The balancing module 32 is used to collect real-time posture parameters of the intelligent mobile terminal and send them to the controller 31, and adjust the balance of the intelligent mobile terminal according to the instructions of the controller 31. The controller 31 is used to execute the control method of the intelligent mobile terminal in the above-mentioned Embodiment 1.
[0095] The balance module 32 also includes an inertial sensor 321, which is used to collect real-time posture parameters of the intelligent mobile terminal. The balance module 32 also includes a distance sensor 322, which is used to collect real-time distance parameters between the intelligent mobile terminal and a flat road surface or a sloped road surface. The balance module 32 also includes a driver 323, which is used to drive the corresponding joint motor to rotate according to the instruction of the controller 31 to adjust the balance of the intelligent mobile terminal. The balancing module 32 also includes a first joint motor 324 arranged on both sides of the body 329, a second joint motor 325 arranged on the chassis connecting rod between the front and rear wheels on the same side, and a third joint motor 326 arranged on each wheel. The second joint motor 325 is fixedly provided with a support connecting rod 327 to connect the body 329. The first joint motor 324 on the same side is connected to the support connecting rod 327 on the second joint motor 325 through an adjustable connecting rod 328. The first joint motor 324 is used to control the body height of the intelligent mobile terminal according to the command of the controller 31, the second joint motor 325 is used to control the angle between the body 329 and the chassis connecting rod according to the command of the controller 31, and the third joint motor 326 is used to drive the intelligent mobile terminal to travel according to the command of the controller 31.
Claims
1. A control method for an intelligent mobile terminal, characterized in that: include: During the driving process of the smart mobile terminal, real-time position and posture parameters of the smart mobile terminal are obtained in real time; Taking the real-time posture parameter as the input of PID control and taking the contact point between the intelligent mobile terminal and the ground as the zero moment point as the target, calculating the posture increment of the real-time posture parameter; The posture of the intelligent mobile terminal is dynamically adjusted according to the posture increment, so as to control the intelligent mobile terminal to be in a balanced state during driving.
2. The control method according to claim 1, characterized in that: Also includes: When the smart mobile terminal is traveling on a flat road or a sloped road, real-time position and posture parameters of the smart mobile terminal and real-time distance parameters between the smart mobile terminal and the flat road or the sloped road are acquired; Taking the real-time posture parameter and the real-time distance parameter as inputs of PID control, taking the contact point between the intelligent mobile terminal and the ground as the zero moment point, and keeping the distance between the intelligent mobile terminal and the flat road surface or the slope road surface unchanged as the goal, calculating the posture increment of the real-time posture parameter and the distance increment of the distance between the intelligent mobile terminal and the flat road surface or the slope road surface; According to the posture increment and the distance increment, the posture of the intelligent mobile terminal and the distance between the intelligent mobile terminal and a flat road or a sloped road are dynamically adjusted to control the intelligent mobile terminal to be in a balanced state during driving on the flat road or the sloped road.
3. The control method according to claim 1, characterized in that: The dynamically adjusting the posture of the intelligent mobile terminal according to the posture increment includes: According to the posture increment, the driver is controlled to drive the corresponding joint motor to rotate, so that the change in the posture of the intelligent mobile terminal after the joint motor rotates is equal to the posture increment.
4. The control method according to claim 2, characterized in that: The dynamically adjusting the posture of the intelligent mobile terminal and the distance between the intelligent mobile terminal and a flat road surface or a sloped road surface according to the posture increment and the distance increment includes: According to the posture increment and the distance increment, the control driver drives the corresponding joint motor to rotate, so that the change in the posture of the intelligent mobile terminal after the rotation of the joint motor is equal to the posture increment, and the change in the distance between the intelligent mobile terminal and a flat road or a sloped road after the rotation of the joint motor is equal to the distance increment.
5. A control system for an intelligent mobile terminal, characterized in that: include: It includes a controller and a balancing module, the controller is connected to the balancing module, the balancing module is used to collect real-time posture parameters of the intelligent mobile terminal and send them to the controller, and adjust the balance of the intelligent mobile terminal according to the instructions of the controller, and the controller is used to execute the control method described in claims 1-4.
6. The control system according to claim 5, characterized in that: The balancing module also includes an inertial navigation sensor, which is used to collect real-time posture parameters of the intelligent mobile terminal.
7. The control system according to claim 5, characterized in that: The balancing module further includes a distance sensor, and the distance sensor is used to collect real-time distance parameters between the intelligent mobile terminal and a flat road surface or a sloped road surface.
8. The control system according to claim 5, characterized in that: The balancing module further includes a driver, and the driver is used to drive the corresponding joint motor to rotate according to the instruction of the controller to adjust the balance of the intelligent mobile terminal.
9. The control system according to claim 5, characterized in that: The balancing module also includes a first joint motor arranged on both sides of the body, a second joint motor arranged on the chassis connecting rod between the front and rear wheels on the same side, and a third joint motor arranged on each wheel. The second joint motors are respectively fixedly provided with support connecting rods to connect the body, and the first joint motor on the same side is connected to the support connecting rod on the second joint motor through an adjustable connecting rod. The first joint motor is used to control the body height of the intelligent mobile terminal according to the command of the controller, the second joint motor is used to control the angle between the body and the chassis connecting rod according to the command of the controller, and the third joint motor is used to drive the intelligent mobile terminal to travel according to the command of the controller.
10. A smart mobile terminal, characterized in that: The intelligent mobile terminal includes the control system described in claims 5-9.
Citation Information
Patent Citations
Closed-loop control-based humanoid robot omnidirectional walking method
CN103149933A
Design of seven-connecting-rod biped robot and hybrid control method based on ZMP and CPG
CN112937721A
Balance control method of biped robot and biped robot
CN116909127A
Robot device and control method of robot device
US20050107916A1
