Control method and control system of intelligent mobile terminal and intelligent mobile terminal

By controlling the landing of the first or rear wheels of the intelligent mobile terminal and collecting inertial navigation parameters in real time, dynamically adjusting the balance, the problem of poor stability of the intelligent mobile terminal during the climbing process is solved, and the stability during driving up and downhill is achieved promote.

CN119024852AActive Publication Date: 2024-11-26GUANGZHOU AUTOMOBILE GROUP CO LTD
View PDF 6 Cites 0 Cited by

Patent Information

Application Number
CN202411206751.9
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

Technical Problem

The intelligent mobile terminal has poor stability during the climbing process. The four-wheeled chassis is prone to overturn. The four-leg and two-legged chassis are insufficient on the ground adhesion, and the two-wheeled chassis can easily cause the road to get stuck in the chassis.

Method used

By controlling the landing of the first or rear wheels of the intelligent mobile terminal, the inertial guide parameters are collected in real time, the balance is dynamically adjusted, the distance between the chassis and the slope is increased, the slope is prevented from jamming the chassis and improving stability.

Benefits of technology

It effectively improves the stability of the smart mobile terminal when driving up and downhill, prevents the slope from getting stuck in the chassis, and enhances driving stability.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119024852A_ABST
    Figure CN119024852A_ABST
Patent Text Reader

Abstract

The invention relates to the technical field of uphill and downhill of intelligent mobile terminals, in particular to a control method and system of an intelligent mobile terminal and the intelligent mobile terminal. And when the intelligent mobile terminal runs uphill and downhill, controlling the front two wheels or the rear two wheels of the intelligent mobile terminal to land, acquiring real-time inertial navigation parameters of the intelligent mobile terminal in real time, and dynamically adjusting the balance of the intelligent mobile terminal when the two wheels land on the ground according to the real-time inertial navigation parameters. According to the method, when the intelligent mobile terminal runs uphill and downhill, according to the real-time inertial navigation parameters, the balance of the intelligent mobile terminal when two wheels touch the ground is dynamically adjusted, the distance between the chassis and the slope surface is increased, the situation that the chassis is clamped by the slope surface is prevented, and the running stability of the intelligent mobile terminal is improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of uphill and downhill intelligent mobile terminals, and in particular to a control method and a control system for an intelligent mobile terminal and an intelligent mobile terminal. Background Art

[0002] With the development of science and technology, various types of intelligent mobile terminals have been widely used in many fields. Intelligent mobile terminals are usually used as basic equipment platforms to carry out relevant scientific research and practical application work, especially in some outdoor investigation and survey work. Due to the complex road environment and certain safety hazards, intelligent mobile terminals are the most widely used basic carrying tools. Affected by road environment factors, intelligent mobile terminals need to have the ability to climb roads with a certain slope. When climbing a slope, the four-wheel chassis is prone to overturning when facing a large slope. The four-legged and two-legged chassis are difficult to obtain sufficient ground adhesion and are prone to slipping. The two-wheeled chassis is prone to getting stuck in the road when climbing a large slope, which makes the intelligent mobile terminal less stable during climbing. Therefore, how to improve the stability of the intelligent mobile terminal during climbing has become an urgent problem to be solved. Summary of the invention

[0003] 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 of poor stability of the smart mobile terminal during climbing.

[0004] A first aspect of an embodiment of the present application provides a control method for an intelligent mobile terminal, including:

[0005] When the smart mobile terminal is traveling uphill or downhill, the front two wheels or the rear two wheels of the smart mobile terminal are controlled to touch the ground, and real-time inertial navigation parameters of the smart mobile terminal are collected in real time;

[0006] The balance of the intelligent mobile terminal when the two wheels are on the ground is dynamically adjusted according to the real-time inertial navigation parameters.

[0007] A second aspect of an embodiment of the present application provides a control system for an intelligent mobile terminal, including a controller, a driving module and a balancing module, wherein the controller is connected to the driving module and the balancing module, the driving module is used to drive the wheels of the intelligent mobile terminal according to the instructions of the controller, the balancing module is used to collect the inertial navigation parameters of the intelligent mobile terminal and send them to the controller, and adjust the balance of the intelligent mobile terminal when the two wheels are on the ground according to the instructions of the controller, and the controller is used to execute the control method of the intelligent mobile terminal described above.

[0008] 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 described above.

[0009] Compared with the prior art, the present invention has the following beneficial effects:

[0010] When the smart mobile terminal is traveling uphill or downhill, the front two wheels or the rear two wheels of the smart mobile terminal are controlled to touch the ground, the real-time inertial navigation parameters of the smart mobile terminal are collected in real time, and the balance of the smart mobile terminal under the two-wheel landing is dynamically adjusted according to the real-time inertial navigation parameters. In the present application, when the smart mobile terminal is traveling uphill or downhill, the balance of the smart mobile terminal under the two-wheel landing is dynamically adjusted according to the real-time inertial navigation parameters, the distance between the chassis and the slope is increased, the situation that the slope surface is prevented from getting stuck on the chassis, and the driving stability of the smart mobile terminal is increased. BRIEF DESCRIPTION OF THE DRAWINGS

[0011] 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.

[0012] Figure 1 It is a flowchart of a control method of an intelligent mobile terminal provided in Embodiment 1 of the present invention;

[0013] Figure 2 is a structural diagram of a control system of an intelligent mobile terminal provided in Embodiment 2 of the present invention;

[0014] Figure 3 This is a schematic diagram of a smart mobile terminal driving uphill provided by Embodiment 3 of the present invention;

[0015] Figure 4 This is a schematic diagram of a smart mobile terminal driving downhill provided by a fourth embodiment of the present invention;

[0016] Figure 5 This is a schematic diagram of a smart mobile terminal provided by Embodiment 5 of the present invention when the two rear wheels are on the ground;

[0017] Figure 6 It is a schematic diagram of an intelligent mobile terminal provided in Embodiment 6 of the present invention. DETAILED DESCRIPTION

[0018] 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.

[0019] 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.

[0020] 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.

[0021] 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.

[0022] 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.

[0023] 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.

[0024] 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.

[0025] In order to illustrate the technical solution of the present invention, the following is described through specific embodiments.

[0026] 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.

[0027] S101: When the smart mobile terminal is traveling uphill or downhill, the front two wheels or the rear two wheels of the smart mobile terminal are controlled to touch the ground, and real-time inertial navigation parameters of the smart mobile terminal are collected in real time.

[0028] In step S101, when the smart mobile terminal is traveling uphill or downhill, the front two wheels or the rear two wheels of the smart mobile terminal are controlled to touch the ground, that is, the four-wheeled foot machine is combined with the two-wheeled foot, and when traveling uphill or downhill, two wheels are used to touch the ground, and real-time inertial navigation parameters of the smart mobile terminal are collected in real time, wherein the real-time inertial navigation parameters include real-time position parameters, real-time speed parameters, real-time pitch angle parameters and angular acceleration parameters of the real-time pitch angle.

[0029] In this embodiment, when the smart mobile terminal is traveling uphill or downhill, the front two wheels or the rear two wheels of the smart mobile terminal are controlled to touch the ground, that is, the smart mobile terminal is converted into a two-wheeled smart mobile terminal, so that when controlling the smart mobile terminal to travel in a balanced manner, the smart mobile terminal can be controlled based on the control of the two-wheeled smart mobile terminal, so that the machine can travel in a balanced manner, reducing the complexity of controlling the smart mobile terminal.

[0030] It should be noted that the front two wheels or the rear two wheels of the smart mobile terminal are controlled to touch the ground, wherein the front two wheels are the two wheels corresponding to the front during the driving of the smart mobile terminal, and the rear two wheels are the two wheels corresponding to the rear during the driving of the smart mobile terminal. When the front two wheels or the rear two wheels of the smart mobile terminal are controlled to touch the ground, the remaining two wheels are lifted. For example, if the front two wheels of the smart mobile terminal are controlled to touch the ground, the rear two wheels are lifted, and if the rear two wheels of the smart mobile terminal are controlled to touch the ground, the front two wheels are lifted.

[0031] Real-time inertial navigation parameters of the intelligent mobile terminal are collected in real time, wherein the real-time inertial navigation parameters include real-time position parameters, real-time speed parameters, real-time pitch angle parameters and angular acceleration parameters of the real-time pitch angle.

[0032] It should be noted that when real-time inertial navigation parameters of the smart mobile terminal are collected in real time, inertial navigation sensors are used for collection.

[0033] Optionally, controlling the front two wheels or the rear two wheels of the smart mobile terminal to land includes:

[0034] Determine the width of the slope and the width of the smart mobile terminal, and if the width of the slope is greater than the width of the smart mobile terminal, control the front two wheels of the smart mobile terminal to touch the ground;

[0035] If the width of the slope is not greater than the width of the intelligent mobile terminal, the rear two wheels of the intelligent mobile terminal are controlled to touch the ground.

[0036] In this embodiment, when determining whether the front two wheels or the rear two wheels of the smart mobile terminal touch the ground, the determination is made based on the width of the slope and the width of the smart mobile terminal. If the width of the slope is greater than the width of the smart mobile terminal, the front two wheels of the smart mobile terminal are controlled to touch the ground. If the width of the slope is not greater than the width of the smart mobile terminal, the rear two wheels of the smart mobile terminal are controlled to touch the ground.

[0037] It should be noted that the width of the smart mobile terminal is the width between two feet of the smart mobile terminal, that is, the distance between chassis connecting rods on both sides, wherein the chassis connecting rods connect two wheels on the same side.

[0038] In this embodiment, when the width of the slope is greater than the width of the smart mobile terminal, the front two wheels of the smart mobile terminal are controlled to touch the ground, so that the chassis coverage area of ​​the smart mobile terminal can be at a greater distance from the slope to prevent the chassis from being stuck on the slope. The chassis coverage area of ​​the smart mobile terminal is the area between the bottom of the body and

[0039] When the width of the slope is not greater than the width of the smart mobile terminal, the rear two wheels of the smart mobile terminal are controlled to touch the ground. Since the width of the slope is not greater than the width of the smart mobile terminal, the four wheels of the smart mobile terminal cannot travel on the slope at the same time. The smart mobile terminal travels uphill on one side, with only one side of the wheels on the slope and the other side of the wheels not on the slope. There is a height difference between the wheels on both sides, which increases the complexity of climbing the slope for the smart mobile terminal. In order to enable the smart mobile terminal to travel up and down slopes, the rear two wheels are used to touch the ground, which increases the climbing ability of the smart mobile terminal, so that the smart mobile terminal can complete the corresponding climbing task.

[0040] S102: Dynamically adjust the balance of the smart mobile terminal on two-wheel landing according to the real-time inertial navigation parameters.

[0041] In step S102, the balance of the intelligent mobile terminal under the two-wheel landing is dynamically adjusted according to the real-time inertial navigation parameters. When dynamically adjusting the balance of the intelligent mobile terminal under the two-wheel landing, the adjustment is performed through an LQR (linear quadratic regulator) algorithm, and the input of the LQR algorithm is the real-time inertial navigation parameters, and the output is the change in the inertial navigation parameters.

[0042] In this embodiment, the balance of the intelligent mobile terminal under two-wheel landing is dynamically adjusted according to the real-time inertial navigation parameters. When the balance of the intelligent mobile terminal under two-wheel landing is dynamically adjusted, the position change amount of the real-time position parameter to be adjusted, the speed change amount of the real-time speed parameter, the pitch angle change amount of the real-time pitch angle parameter and the angular velocity change amount of the angular acceleration parameter of the real-time pitch angle are calculated according to the real-time inertial navigation parameters including the real-time position parameter, the real-time speed parameter, the real-time pitch angle parameter and the angular velocity change amount of the angular acceleration parameter of the real-time pitch angle.

[0043] It should be noted that, according to the real-time inertial navigation parameters, the balance of the intelligent mobile terminal under two-wheel landing is dynamically adjusted, that is, according to the position change, speed change, pitch angle change and angular velocity change, the adjusted position of the intelligent mobile terminal is the position after the real-time position parameter is added to the position change, the adjusted speed of the intelligent mobile terminal is the value after the real-time speed is added to the speed change, the adjusted pitch angle of the intelligent mobile terminal is the value after the real-time position pitch angle is added to the pitch angle change, and the angular acceleration of the adjusted pitch angle of the intelligent mobile terminal is the value after the real-time pitch angle is added to the angular acceleration of the real-time pitch angle and the angular velocity change. The intelligent mobile terminal is controlled to reach the adjusted position, adjusted speed, adjusted pitch angle and adjusted angular acceleration of the pitch angle. In this way, the intelligent mobile terminal can travel in a balanced manner during uphill and downhill driving, thereby improving the driving stability of the intelligent mobile terminal.

[0044] Optionally, dynamically adjusting the balance of the intelligent mobile terminal under two-wheel landing according to the real-time inertial navigation parameters includes:

[0045] If the front two wheels of the intelligent mobile terminal are controlled to touch the ground, when the intelligent mobile terminal is traveling uphill, the servo motor of the intelligent mobile terminal is controlled to rotate counterclockwise, and the balance of the intelligent mobile terminal when the front two wheels touch the ground is dynamically adjusted according to the real-time inertial navigation parameters;

[0046] When the intelligent mobile terminal is traveling downhill, the servo motor of the intelligent mobile terminal is controlled to rotate clockwise, and the balance of the intelligent mobile terminal under the first two wheels is dynamically adjusted according to the real-time inertial navigation parameters.

[0047] In this embodiment, according to the real-time inertial navigation parameters, i.e., the real-time position parameters, the real-time speed parameters, the real-time pitch angle parameters and the angular acceleration parameters of the real-time pitch angle, the balance of the intelligent mobile terminal under the two-wheel landing is dynamically adjusted. When the wheels at different ends are touching the ground, the corresponding adjustment strategies are different. When the wheels at the same end are touching the ground, the corresponding adjustment strategies are also different when going uphill and downhill. If the front two wheels of the intelligent mobile terminal are controlled to touch the ground, when the intelligent mobile terminal is driving uphill, the servo motor of the intelligent mobile terminal is controlled to rotate counterclockwise, and the balance of the intelligent mobile terminal under the front two wheels is dynamically adjusted according to the real-time inertial navigation parameters. There are two servo motors in each foot test, one of which is used to control the front two wheels of the intelligent mobile terminal to touch the ground, and the other servo motor is used to control the height of the body. In order to keep the intelligent mobile terminal balanced, the rotation angles of the servo motors on the two foot sides are the same.

[0048] It should be noted that when the smart mobile terminal is traveling uphill, the servo motor controlling the smart mobile terminal rotates counterclockwise, wherein one servo motor rotates counterclockwise to raise the height of the two rear wheels so that the two rear wheels are off the ground, and the other servo motor rotates counterclockwise to increase the height of the body, thereby increasing the distance between the chassis coverage area of ​​the smart mobile terminal and the slope, preventing the chassis from being stuck on the slope.

[0049] When the intelligent mobile terminal is traveling downhill, the servo motor of the intelligent mobile terminal is controlled to rotate clockwise according to the real-time inertial navigation parameters, namely, the real-time position parameter, the real-time speed parameter, the real-time pitch angle parameter and the angular acceleration parameter of the real-time pitch angle, so as to dynamically adjust the balance of the intelligent mobile terminal when the front two wheels land. When the servo motor rotates clockwise, one of the servo motors is used to control the front two wheels of the intelligent mobile terminal to land, and the other servo motor is used to lower the height of the body. In order to keep the intelligent mobile terminal balanced, the rotation angles of the servo motors on the two foot sides are the same.

[0050] It should be noted that when the smart mobile terminal is traveling downhill, the servo motor controlling the smart mobile terminal rotates clockwise, wherein one servo motor rotates counterclockwise to raise the height of the two rear wheels so that the two rear wheels are off the ground, and the other servo motor rotates clockwise to lower the height of the machine body, thereby lowering the center of gravity of the machine body and improving the driving stability of the smart mobile terminal.

[0051] Optionally, dynamically adjusting the balance of the intelligent mobile terminal when the two wheels are on the ground according to the real-time inertial navigation parameters also includes:

[0052] If the rear two wheels of the smart mobile terminal are controlled to touch the ground, the height difference between the two sides of the smart mobile terminal is obtained;

[0053] According to the height difference, the servo motor on one foot side of the intelligent mobile terminal is controlled to rotate counterclockwise, and the servo motor on the other foot side is controlled to rotate clockwise, so that the height of the foot side corresponding to the clockwise rotation of the servo motor is equal to the height of the foot side corresponding to the counterclockwise rotation of the servo motor;

[0054] After the height of the foot side corresponding to the clockwise rotation of the servo motor is equal to the height of the foot side corresponding to the counterclockwise rotation of the servo motor, the balance of the intelligent mobile terminal on the two-wheel landing is dynamically adjusted according to the real-time inertial navigation parameters.

[0055] In this embodiment, the balance of the smart mobile terminal when the two wheels touch the ground is dynamically adjusted according to the real-time inertial navigation parameters, namely, the real-time position parameter, the real-time speed parameter, the real-time pitch angle parameter and the angular acceleration parameter of the real-time pitch angle. Since the width of the slope is not greater than that of the smart mobile terminal, the four wheels of the smart mobile terminal cannot travel on the slope at the same time. When the smart mobile terminal travels uphill on one side, only the wheel on one foot side is on the slope, and the wheel on the other foot side is not on the slope. The wheels on the two foot sides form a corresponding height difference. Therefore, if the rear two wheels of the smart mobile terminal are controlled to touch the ground, the height difference on both sides of the smart mobile terminal is obtained, so as to eliminate the corresponding height difference by adjusting the rotation angle of the servo motor, so that the smart mobile terminal can travel smoothly.

[0056] According to the height difference, the servo motor on one foot side of the intelligent mobile terminal is controlled to rotate counterclockwise, and the servo motor on the other foot side is controlled to rotate clockwise, so that the sum of the height of the foot side corresponding to the clockwise rotation of the servo motor and the height difference is equal to the height of the foot side corresponding to the counterclockwise rotation of the servo motor. Among them, the height of the wheel on the foot side on the slope is greater than the height of the wheel on the foot side not on the slope, and the wheel on the foot side on the slope forms a corresponding height difference with the wheel on the foot side not on the slope. The servo motor on the wheel on the foot side on the slope rotates clockwise to reduce the height of the corresponding side body, and the servo motor on the wheel on the foot side not on the slope rotates counterclockwise to increase the height of the corresponding side body, so that the height of the corresponding foot side after the servo motor rotates clockwise is equal to the height of the corresponding foot side when the servo motor rotates counterclockwise. After the height of the corresponding foot side after the servo motor rotates clockwise is equal to the height of the corresponding foot side when the servo motor rotates counterclockwise, the balance of the intelligent mobile terminal under the two-wheel landing is dynamically adjusted according to the real-time inertial navigation parameters. Among them, when dynamically adjusting the balance of the intelligent mobile terminal under the two-wheel landing, the adjustment is performed through the LQR algorithm. The input of the LQR algorithm is the real-time inertial navigation parameters, and the output is the change of the inertial navigation parameters.

[0057] In this embodiment, according to the height difference, the servo motor on one foot side of the smart mobile terminal is controlled to rotate counterclockwise, and the servo motor on the other foot side is controlled to rotate clockwise, so that the height of the foot side corresponding to the clockwise rotation of the servo motor is equal to the height of the foot side corresponding to the counterclockwise rotation of the servo motor, so as to increase the stability of the smart mobile terminal.

[0058] When the smart mobile terminal is traveling uphill or downhill, the front two wheels or the rear two wheels of the smart mobile terminal are controlled to touch the ground, the real-time inertial navigation parameters of the smart mobile terminal are collected in real time, and the balance of the smart mobile terminal under the two-wheel landing is dynamically adjusted according to the real-time inertial navigation parameters. In the present application, when the smart mobile terminal is traveling uphill or downhill, the balance of the smart mobile terminal under the two-wheel landing is dynamically adjusted according to the real-time inertial navigation parameters, the distance between the chassis and the slope is increased, the situation that the slope surface is prevented from getting stuck on the chassis, and the driving stability of the smart mobile terminal is increased.

[0059] See also Figure 2 , is a structural diagram of a control system 20 of an intelligent mobile terminal provided in Embodiment 2 of the present invention. Figure 2 As shown, the control system of the intelligent mobile terminal includes a controller 21, a driving module 22 and a balancing module 23. The controller 21 is connected to the driving module 22 and the balancing module 23. The driving module 22 is used to drive the wheels 24 of the intelligent mobile terminal according to the instructions of the controller 21. The balancing module 23 is used to collect the inertial navigation parameters of the intelligent mobile terminal and send them to the controller 21, and adjust the balance of the intelligent mobile terminal when the two wheels are on the ground according to the instructions of the controller 21. The controller 21 is used to execute the control method of the intelligent mobile terminal in the above-mentioned embodiment one.

[0060] See also Figure 2 The balancing module 23 includes an inertial navigation sensor 235, which is used to collect real-time inertial navigation parameters of the intelligent mobile terminal. The real-time inertial navigation parameters include real-time position parameters, real-time speed parameters, real-time pitch angle parameters and angular acceleration parameters of the real-time pitch angle.

[0061] See also Figure 2 The balancing module 23 includes a first servo motor 231 disposed on the chassis link 25 between the left front and rear wheels and a second servo motor 232 disposed on the chassis link 25 between the right front and rear wheels. The first servo motor 231 and the second servo motor 232 are respectively fixedly disposed on the support link 27 to connect the machine body 28. The first servo motor and the second servo motor are used to control the angle between the machine body 28 and the chassis link 25 according to the command of the controller 21. The first servo motor 231 and the second servo motor 232 are disposed at the middle position of the chassis link 25.

[0062] The balancing module 23 also includes a third servo motor 233 and a fourth servo motor 234 arranged on the body 28. The third servo motor 233 is connected to the support link 27 on the first servo motor 231 through an adjustable link 26, and the fourth servo motor 234 is connected to the support link 27 on the second servo motor 232 through an adjustable link 26. The third servo motor 233 and the fourth servo motor 234 are used to control the height between the body 28 and the chassis link 25 according to the instructions of the controller 21.

[0063] It should be noted that the controller 21 is used to control the front two wheels or the rear two wheels of the smart mobile terminal to touch the ground when the smart mobile terminal is traveling uphill or downhill, and to control the inertial navigation sensor 235 to collect real-time inertial navigation parameters of the smart mobile terminal, and dynamically adjust the balance of the smart mobile terminal when the two wheels touch the ground according to the real-time inertial navigation parameters.

[0064] The step of controlling the front two wheels or the rear two wheels of the intelligent mobile terminal to touch the ground includes:

[0065] Determine the width of the slope and the width of the smart mobile terminal, and if the width of the slope is greater than the width of the smart mobile terminal, control the front two wheels of the smart mobile terminal to touch the ground;

[0066] If the width of the slope is not greater than the width of the intelligent mobile terminal, the rear two wheels of the intelligent mobile terminal are controlled to touch the ground.

[0067] According to the real-time inertial navigation parameters, the balance of the intelligent mobile terminal on two wheels is dynamically adjusted, including:

[0068] If the front two wheels of the intelligent mobile terminal are controlled to touch the ground, when the intelligent mobile terminal is traveling uphill, the servo motor of the intelligent mobile terminal is controlled to rotate counterclockwise, and the balance of the intelligent mobile terminal when the front two wheels touch the ground is dynamically adjusted according to the real-time inertial navigation parameters.

[0069] See also Figure 3 , is a schematic diagram of an intelligent mobile terminal provided in Embodiment 3 of the present invention when driving uphill. When driving uphill, the front two wheels touch the ground, and the first servo motor 231 and the second servo motor 232 are controlled to rotate counterclockwise to raise the height of the rear two wheels, wherein the angle between the chassis link 25 and the support link 27 is 60 degrees.

[0070] When the smart mobile terminal is traveling uphill, the first servo motor 231 and the second servo motor 232 of the smart mobile terminal are controlled to rotate counterclockwise, wherein the rotation angles of the first servo motor 231 and the second servo motor 232 are the same.

[0071] It should be noted that when the smart mobile terminal is traveling uphill, the first servo motor 231 and the second servo motor 232 of the smart mobile terminal are controlled to rotate counterclockwise, wherein the counterclockwise rotation of the first servo motor 231 can raise the height of the two rear wheels so that the two rear wheels are not touching the ground, and the counterclockwise rotation of the second servo motor 232 increases the height of the body 28, thereby increasing the distance between the chassis coverage area of ​​the smart mobile terminal and the slope surface, preventing the chassis from being stuck on the slope surface.

[0072] When the intelligent mobile terminal is traveling downhill, the servo motor of the intelligent mobile terminal is controlled to rotate clockwise, and the balance of the intelligent mobile terminal under the first two wheels is dynamically adjusted according to the real-time inertial navigation parameters.

[0073] See also Figure 4 , is a schematic diagram of a smart mobile terminal provided in Embodiment 4 of the present invention when driving downhill. When driving downhill, the front two wheels touch the ground, and the first servo motor 231 and the second servo motor 232 are controlled to rotate counterclockwise to raise the height of the rear two wheels, wherein the angle between the chassis link 25 and the support link 27 is 60 degrees.

[0074] When the intelligent mobile terminal is traveling downhill, the first servo motor 231 and the second servo motor 232 of the intelligent mobile terminal are controlled to rotate counterclockwise, wherein the rotation angles of the first servo motor 231 and the second servo motor 232 are the same.

[0075] See also Figure 5 , is a schematic diagram of a smart mobile terminal with two rear wheels touching the ground provided by Embodiment 5 of the present invention. If the rear two wheels of the smart mobile terminal are controlled to touch the ground, the height difference between the two sides of the smart mobile terminal is obtained; according to the height difference, the servo motor on one foot side of the smart mobile terminal is controlled to rotate counterclockwise, and the servo motor on the other foot side is controlled to rotate clockwise, so that the height of the foot side corresponding to the clockwise rotation of the servo motor is equal to the height of the foot side corresponding to the counterclockwise rotation of the servo motor.

[0076] Among them, the height of the wheel 24 on the side of the foot on the slope is greater than the height of the wheel 24 on the side of the foot not on the slope, and the wheel 24 on the side of the foot on the slope forms a corresponding height difference with the wheel 24 on the side of the foot not on the slope. The servo motor on the wheel 24 on the side of the foot on the slope rotates clockwise to reduce the height of the corresponding side body 28, and the servo motor on the wheel 24 on the side of the foot not on the slope rotates counterclockwise to increase the height of the corresponding side body 28, so that the height of the corresponding side of the foot after the servo motor rotates clockwise is equal to the height of the corresponding side of the foot when the servo motor rotates counterclockwise. After the height of the corresponding side of the foot after the servo motor rotates clockwise is equal to the height of the corresponding side of the foot when the servo motor rotates counterclockwise, the balance of the intelligent mobile terminal on the ground of the two wheels is dynamically adjusted according to the real-time inertial navigation parameters.

[0077] See also Figure 6, is a smart mobile terminal 60 provided in Example 6 of the present invention, the smart mobile terminal 60 includes the above-mentioned smart mobile terminal control system 20, the smart mobile terminal control system 20 includes a controller 21, a driving module 22 and a balancing module 23, the control system of the smart mobile terminal includes the controller 21, the driving module 22 and the balancing module 23, the controller 21 is connected to the driving module 22 and the balancing module 23, the driving module 22 is used to drive the wheels 24 of the smart mobile terminal according to the instructions of the controller, the balancing module 23 is used to collect the inertial navigation parameters of the smart mobile terminal and send them to the controller 21, and adjust the balance of the smart mobile terminal under the two-wheel landing according to the instructions of the controller 21, and the controller 21 is used to execute the control method of the smart mobile terminal in the above-mentioned Example 1.

[0078] The balancing module 23 includes an inertial navigation sensor 235, which is used to collect real-time inertial navigation parameters of the intelligent mobile terminal, wherein the real-time inertial navigation parameters include real-time position parameters, real-time speed parameters, real-time pitch angle parameters and angular acceleration parameters of the real-time pitch angle.

[0079] The balancing module 23 includes a first servo motor 231 disposed on the chassis link 25 between the left front and rear wheels and a second servo motor 232 disposed on the chassis link 25 between the right front and rear wheels. The first servo motor 231 and the second servo motor 232 are respectively fixedly disposed on the support link 27 to connect the machine body 28. The first servo motor and the second servo motor are used to control the angle between the machine body 28 and the chassis link 25 according to the command of the controller 21. The first servo motor 231 and the second servo motor 232 are disposed at the middle position of the chassis link 25.

[0080] The balancing module 23 also includes a third servo motor 233 and a fourth servo motor 234 arranged on the body 28. The third servo motor 233 is connected to the support link 27 on the first servo motor 231 through an adjustable link 26, and the fourth servo motor 234 is connected to the support link 27 on the second servo motor 232 through an adjustable link 26. The third servo motor 233 and the fourth servo motor 234 are used to control the height between the body 28 and the chassis link 25 according to the instructions of the controller 21.

Claims

1. A control method for an intelligent mobile terminal, characterized in that: include: When the smart mobile terminal is traveling uphill or downhill, the front two wheels or the rear two wheels of the smart mobile terminal are controlled to touch the ground, and real-time inertial navigation parameters of the smart mobile terminal are collected in real time; The balance of the intelligent mobile terminal when the two wheels are on the ground is dynamically adjusted according to the real-time inertial navigation parameters.

2. The control method according to claim 1, characterized in that: The real-time inertial navigation parameters include real-time position parameters, real-time speed parameters, real-time pitch angle parameters and real-time angular acceleration parameters of the pitch angle.

3. The control method according to claim 1, characterized in that: The controlling the front two wheels or the rear two wheels of the smart mobile terminal to land comprises: Determine the width of the slope and the width of the smart mobile terminal, and if the width of the slope is greater than the width of the smart mobile terminal, control the front two wheels of the smart mobile terminal to touch the ground; If the width of the slope is not greater than the width of the smart mobile terminal, the rear two wheels of the smart mobile terminal are controlled to touch the ground.

4. The control method according to claim 3, characterized in that: The dynamically adjusting the balance of the intelligent mobile terminal under two-wheel landing according to the real-time inertial navigation parameters includes: If the front two wheels of the smart mobile terminal are controlled to touch the ground, then when the smart mobile terminal is traveling uphill, the servo motor of the smart mobile terminal is controlled to rotate counterclockwise, and the balance of the smart mobile terminal when the front two wheels touch the ground is dynamically adjusted according to the real-time inertial navigation parameters; When the intelligent mobile terminal is traveling downhill, the servo motor of the intelligent mobile terminal is controlled to rotate clockwise, and the balance of the intelligent mobile terminal under the first two wheels is dynamically adjusted according to the real-time inertial navigation parameters.

5. The control method according to claim 3, characterized in that: The dynamically adjusting the balance of the intelligent mobile terminal under two-wheel landing according to the real-time inertial navigation parameters also includes: If the rear two wheels of the smart mobile terminal are controlled to touch the ground, obtaining a height difference between two sides of the smart mobile terminal; According to the height difference, control the servo motor on one foot side of the smart mobile terminal to rotate counterclockwise, and the servo motor on the other foot side to rotate clockwise, so that the height of the foot side corresponding to the clockwise rotation of the servo motor is equal to the height of the foot side corresponding to the counterclockwise rotation of the servo motor; After the height of the foot side corresponding to the clockwise rotation of the servo motor is equal to the height of the foot side corresponding to the counterclockwise rotation of the servo motor, the balance of the intelligent mobile terminal on two-wheel landing is dynamically adjusted according to the real-time inertial navigation parameters.

6. A control system for an intelligent mobile terminal, characterized in that: It includes a controller, a driving module and a balancing module, the controller is connected to the driving module and the balancing module, the driving module is used to drive the wheels of the intelligent mobile terminal according to the instructions of the controller, the balancing module is used to collect the inertial navigation parameters of the intelligent mobile terminal and send them to the controller, and adjust the balance of the intelligent mobile terminal when the two wheels are on the ground according to the instructions of the controller, and the controller is used to execute the control method described in claims 1-5.

7. The control system according to claim 6, characterized in that: The balancing module includes an inertial navigation sensor, and the inertial navigation sensor is used to collect real-time inertial navigation parameters of the intelligent mobile terminal.

8. The control system according to claim 6, characterized in that: The balancing module includes a first servo motor arranged on a chassis link between the left front and rear wheels and a second servo motor arranged on a chassis link between the right front and rear wheels. The first servo motor and the second servo motor are respectively fixedly arranged on a supporting link to connect the machine body. The first servo motor and the second servo motor are used to control the angle between the machine body and the chassis link according to the instructions of the controller.

9. The control system according to claim 8, characterized in that: The balancing module also includes a third servo motor and a fourth servo motor arranged on the body, the third servo motor is connected to the support connecting rod on the first servo motor through an adjustable connecting rod, and the fourth servo motor is connected to the support connecting rod on the second servo motor through an adjustable connecting rod. The third servo motor and the fourth servo motor are used to control the height between the body and the chassis connecting rod according to the instructions of the controller.

10. A smart mobile terminal, characterized in that: The intelligent mobile terminal includes the control system described in claims 6-9.

Citation Information

Patent Citations

  • Method for correcting odometer error of suspended back wheel in downhill by inertial sensor and pressure sensor

    CN107063305A

  • Simulated remote control vehicle

    CN108325212A

  • Robot chassis

    CN112959865A

  • Vehicle chassis lifting control method, terminal equipment and storage medium

    CN115431694A

  • Vehicle control method and device and vehicle

    CN116588110A