Robot control method, device and equipment

By using sliding mode control method and fractional calculus operator on cloud servers, the problem that robot control in the prior art is difficult to reduce jitter is solved, and the controller jitter is reduced without the impact of robustness. and the effect of robot jitter.

CN118938665APending Publication Date: 2024-11-12CHINA MOBILE (SUZHOU) SOFTWARE TECH CO LTD +1
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410986476.0
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-23
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

Existing robot control solutions are difficult to reduce robot jitter while ensuring robustness.

Method used

The robot is controlled by a cloud server, and the sliding mode control method and fractional calculus operator are used to determine the position and attitude control law based on the robot disturbance information. The control instructions are sent through the cloud server to realize the robot moving along the expected trajectory.

Benefits of technology

Without losing convergence speed and not affecting robustness, the jitter of the controller is significantly reduced, the problems of robot jitter and noise are avoided, the local resource occupation is reduced, and the efficiency of multi-robot trajectory tracking control is improved.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118938665A_ABST
    Figure CN118938665A_ABST
Patent Text Reader

Abstract

The invention provides a robot control method, device and equipment, and relates to the technical field of cloud computing. The method comprises the following steps: acquiring task information sent by a remote client and robot state information sent by a robot; determining an expected track of the robot according to the task information and the robot state information; according to a sliding mode control method and robot disturbance information, the robot is controlled to move along the expected track, and the sliding mode control method is a control method related to fractional calculus. According to the scheme, the fractional calculus is introduced into the division control method, the buffeting of the controller can be remarkably reduced by adjusting the order of the fractional order, and the fractional order has the characteristic of rapid convergence and is not sensitive to the influence on the robustness, so that the control algorithm disclosed by the invention can improve the control efficiency on the premise of not losing the convergence speed and not influencing the robustness. And the problem that the robot shakes due to vibration of the controller is avoided.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of cloud computing technology, and in particular to a robot control method, device and equipment. Background Art

[0002] With the development of industrial automation, more and more mission scenarios are beginning to use robots, and robot trajectory tracking is the basis for their execution of tasks. At present, the trajectory tracking control of mobile robots basically adopts robot local computing, which concentrates the interaction module, controller module, actuator module, sensor module, etc. on the robot, sets tasks for the robot through the interaction module, obtains the robot status through the sensor, and designs control rules for it through the controller. Finally, the robot is driven by the actuator to complete the task. However, it is difficult to reduce the jitter of the robot while ensuring robustness in the existing robot control scheme. Summary of the invention

[0003] The purpose of the present application is to provide a robot control method, device and equipment to solve the problem that it is difficult to reduce the jitter of the robot while ensuring robustness in existing robot control solutions.

[0004] To achieve the above object, an embodiment of the present application provides a robot control method, which is applied to a cloud server, and the method includes:

[0005] Get the task information sent by the remote client and the robot status information sent by the robot;

[0006] Determining a desired trajectory of the robot according to the task information and the robot state information;

[0007] According to the sliding mode control method and the robot disturbance information, the robot is controlled to move along the desired trajectory, and the sliding mode control method is a control method related to fractional calculus.

[0008] Optionally, controlling the robot to move along the desired trajectory according to the sliding mode control method and the robot disturbance information includes:

[0009] According to the sliding mode control method and the robot disturbance information, determine the position control law and the attitude control law of the robot, wherein the position control law is used to realize the robot tracking the position in the desired trajectory, and the attitude control law is used to realize the robot tracking the attitude angle in the desired trajectory;

[0010] A control instruction is sent to the robot, wherein the control instruction includes the position control law and the posture control law.

[0011] Optionally, determining the position control law and attitude control law of the robot according to the sliding mode control method and the robot disturbance information includes:

[0012] Determine a sliding surface function according to a fractional-order calculus operator and tracking error information of the robot, wherein the tracking error information includes position tracking error information and attitude angle tracking error information;

[0013] The position control law and the posture control law of the robot are determined according to the sliding surface function and the robot disturbance information.

[0014] Optionally, determining the position control law and attitude control law of the robot according to the sliding surface function and the robot disturbance information includes:

[0015] According to the robot disturbance information, the position error tracking equation and the attitude angle error tracking equation are obtained;

[0016] Determine the position control law of the robot according to the sliding surface function and the position error tracking equation;

[0017] Determine the attitude control law of the robot according to the sliding surface function and the attitude angle tracking method;

[0018] Wherein, the position error tracking equation satisfies the following formula:

[0019]

[0020] The attitude angle error tracking equation satisfies the following formula:

[0021]

[0022] Among them, x e represents the robot tracking error in the x-axis direction, y e represents the robot tracking error in the y-axis direction, d1 represents the robot disturbance value in the x-axis direction, d2 represents the robot disturbance value in the y-axis direction, θ represents the robot posture angle, x d represents the coordinate of the desired trajectory in the x-axis direction, y d represents the coordinate of the desired trajectory in the y-axis direction, and v represents the position control law;

[0023] θ e represents the robot posture angle tracking error, d3 represents the robot disturbance value in the robot posture angle direction, θ d represents the desired attitude angle, and w represents the attitude control law.

[0024] Optionally, the sliding surface function satisfies the following formula:

[0025] s=D α Δ+cI 1-α Sig r (Δ);

[0026] Where s represents the sliding surface, D α represents the α-order fractional differential operation, I 1-α represents the 1-α order fractional integral operation, α represents the fractional calculus operator, r and c are constants for adjusting convergence, and 0<α<1, 0 <r<1,c> 0;Sig r (Δ)=sgn(Δ)|Δ| r , Δ represents x e ,y e or θ e , x e represents the robot tracking error in the x-axis direction, y e represents the robot tracking error in the y-axis direction, θ e represents the robot posture angle tracking error,

[0027] Optionally, the method of the embodiment of the present application further includes:

[0028] The robot disturbance information is estimated according to the tracking error information of the robot, the position control law and the posture control law.

[0029] Optionally, estimating the robot disturbance information according to the tracking error information of the robot, the position control law and the posture control law includes:

[0030] The robot disturbance information is estimated by the following formula:

[0031]

[0032] Among them, Z=[x yθ]; F(v,w,θ)=[v cosθv sinθw] T ;

[0033] R=[d1 d2 d3] T , Z=F(v,w,θ)+R,Z e =[x e y e θ e ] T ;

[0034] R represents the robot disturbance information, d1 represents the robot disturbance value in the x-axis direction, d2 represents the robot disturbance value in the y-axis direction, d3 represents the robot disturbance value in the robot posture angle direction, e represents the robot tracking error in the x-axis direction, y e represents the robot tracking error in the y-axis direction, θ erepresents the robot's posture angle tracking error, w represents the posture control law, v represents the position control law, represents the robot's posture angle, k1, k2, k3 and k4 are all constants used to adjust the convergence.

[0035] The present application also provides a robot control device, which is applied to a cloud server, and the device includes:

[0036] The acquisition module is used to obtain the task information sent by the remote client and the robot status information sent by the robot;

[0037] A determination module, used to determine the expected trajectory of the robot according to the task information and the robot state information;

[0038] A control module is used to control the robot to move along the desired trajectory according to a sliding mode control method and robot disturbance information, wherein the sliding mode control method is a control method related to fractional calculus.

[0039] The embodiment of the present application also provides a robot control device, which is applied to a cloud server, and the device includes: a transceiver and a processor;

[0040] The transceiver is used to obtain task information sent by the remote client and robot status information sent by the robot;

[0041] The processor is used to determine the desired trajectory of the robot according to the task information and the robot state information; and control the robot to move along the desired trajectory according to a sliding mode control method and robot disturbance information, wherein the sliding mode control method is a control method related to fractional calculus.

[0042] An embodiment of the present application also provides a robot control system, comprising: a cloud server, a remote client and at least one robot respectively communicating with the cloud server, and the cloud server is used to execute the steps of the robot control method as described above.

[0043] An embodiment of the present application also provides a computer-readable storage medium, on which a computer program is stored. When the computer program is executed by a processor, the steps of the robot control method as described above are implemented.

[0044] An embodiment of the present application also provides a computer program product, including computer instructions, which implement the steps of the robot control method as described above when executed by a processor.

[0045] The beneficial effects of the above technical solution of the present application are as follows:

[0046] In the above scheme of the embodiment of the present application, the cloud server obtains the task information sent by the remote client and the robot state information sent by the robot; determines the desired trajectory of the robot according to the task information and the robot state information; controls the robot to move along the desired trajectory according to the sliding mode control method and the robot disturbance information. In the above scheme, the cloud server controls the control trajectory of the peer robot without occupying the local resources of the robot to track and control the robot. Since the cloud service has powerful computing power, in the above scheme, fractional calculus is introduced into the partition control method. By adjusting the fractional order, the controller jitter can be significantly reduced. The fractional order has the characteristics of fast convergence and is insensitive to the influence of robustness. Therefore, the control algorithm of the present application can avoid the problem of robot jitter caused by controller vibration without losing the convergence speed and affecting the robustness. BRIEF DESCRIPTION OF THE DRAWINGS

[0047] Figure 1 A schematic diagram of a flow chart of a robot control method according to an embodiment of the present application;

[0048] Figure 2 A schematic diagram of the overall system architecture of a robot control system according to an embodiment of the present application;

[0049] Figure 3 A block diagram of trajectory tracking control of a mobile robot based on a cloud platform in an embodiment of the present application;

[0050] Figure 4 This is a planar working schematic diagram of the mobile robot in an embodiment of the present application;

[0051] Figure 5 A schematic diagram of a module of a robot control device according to an embodiment of the present application;

[0052] Figure 6 This is one of the structural block diagrams of the robot control device in the embodiment of the present application;

[0053] Figure 7 This is the second structural block diagram of the robot control device in the embodiment of the present application. DETAILED DESCRIPTION

[0054] In order to make the technical problems, technical solutions and advantages to be solved by the present application clearer, a detailed description will be given below with reference to the accompanying drawings and specific embodiments.

[0055] It should be understood that the references to "one embodiment" or "an embodiment" throughout the specification mean that the specific features, structures, or characteristics associated with the embodiment are included in at least one embodiment of the present application. Therefore, the references to "in one embodiment" or "in an embodiment" appearing throughout the specification do not necessarily refer to the same embodiment. In addition, these specific features, structures, or characteristics may be combined in any suitable manner in one or more embodiments.

[0056] In the various embodiments of the present application, it should be understood that the size of the serial numbers of the following processes does not mean the order 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 application.

[0057] Additionally, the terms "system" and "network" are often used interchangeably herein.

[0058] In the embodiments provided in the present application, it should be understood that "B corresponding to A" means that B is associated with A, and B can be determined according to A. However, it should also be understood that determining B according to A does not mean determining B only according to A, and B can also be determined according to A and / or other information.

[0059] like Figure 1 As shown, a robot control method according to an embodiment of the present application is applied to a cloud server (i.e., executed by a cloud server), and the method includes:

[0060] Step 101: Obtain task information sent by the remote client and robot status information sent by the robot.

[0061] Optionally, the task information includes path planning, target setting and / or sensor acquisition of the robot.

[0062] As an implementation method, the user can input relevant parameters and instructions of the task through the task publishing interface of the remote client.

[0063] Optionally, the robot state information includes task execution results and / or sensor data, etc. For example, the sensor data includes the robot's position, movement direction, speed (such as the robot's wheel speed), operating state, etc.

[0064] Step 102: Determine the expected trajectory of the robot according to the task information and the robot state information.

[0065] In the embodiment of the present application, the destination that the robot needs to reach can be determined based on the above task information, and the desired trajectory is planned for the robot based on the target destination and the robot state information. The cloud server (i.e., cloud server) determines the path of the robot through the user's task and the trajectory planning algorithm, thereby determining the desired trajectory of the mobile robot (hereinafter described as the robot).

[0066] Step 103: According to a sliding mode control method and the robot disturbance information, the robot is controlled to move along the desired trajectory, wherein the sliding mode control method is a control method related to fractional calculus.

[0067] Optionally, the robot disturbance information includes disturbance caused by system uncertainty and / or disturbance of the system by the external environment.

[0068] Since the sliding mode control method includes a switching function, and the switching function is a discontinuous function, this will cause serious jitter to the controller, which will cause the robot to vibrate or generate noise. The relevant scheme uses an integral method (integer-order calculus) to reduce the vibration of the controller, but this is at the expense of the robustness of the controller and the rapid convergence of the system. The scheme of the present application introduces fractional-order calculus into the partition control method. By adjusting the fractional order, the jitter of the controller can be significantly reduced. The fractional order has the characteristics of rapid convergence and is insensitive to the influence of robustness. Therefore, the control algorithm of the present application can avoid the vibration problem caused by the controller without losing the convergence speed and affecting the robustness, thereby avoiding jitter or noise in the robot.

[0069] In addition, when the task information is task information corresponding to multiple robots, the cloud server determines the expected trajectory of each robot based on the state information of each robot, and controls each robot to move along the corresponding expected trajectory based on the sliding mode control method related to fractional calculus and the robot disturbance information.

[0070] Since a large amount of control data, calculus operations, etc. are required for the trajectory tracking and control of multiple robots, the calculation amount is large and complex. Therefore, this application is based on a cloud server, relying on the powerful computing and data analysis capabilities of the cloud to realize the calculation of robot control laws, instead of using the robot local computing mode to realize data sharing between robots. This can effectively avoid robot collisions, reduce the high cost of controllers in local robots, and realize remote trajectory tracking and control of multiple robots.

[0071] like Figure 2As shown, it is a system overall architecture diagram of the robot control system of an embodiment of the present application. The entire system is designed around a common client / server architecture and consists of a cloud server and two types of clients (remote clients and local clients). The local client includes multiple robot actuators (or described as robots). Among them, a remote client connects the user to the robot through the cloud server, while the other client ensures direct communication between the server and the mobile robot group, so that the robot and user networks are clearly separated. The cloud server is the core of the main data processing in the entire system. It implements a Web interface for data sending and receiving. These data are stored and indexed through a MySQL database and managed by the cloud server. In addition to providing a control interface for the user, the remote client also includes a Web module required to establish communication with the cloud server. Among them, the fractional-order finite-time controller may include a position subsystem fractional-order finite-time controller and a posture subsystem fractional-order finite-time controller.

[0072] In terms of the connection between the cloud server and the mobile robot, the robot and the cloud establish their own communication links. This decentralized architecture does not provide centralized synchronization, but it can reduce the communication load between the robot and the cloud server, especially when the number of robots increases. Decentralization can also improve the flexibility of the network layer used without affecting the robot interface design. The remote client establishes an independent link with the server to provide users with real-time robot status information and publish tasks. After the cloud receives the user's task and the robot status information, it obtains the control logic of each robot according to the control algorithm and sends the data to the robot, so that the robot performs the task.

[0073] The cloud server, remote client, and local client in the overall architecture of the above system are described in detail below.

[0074] 1. Cloud server;

[0075] The cloud server is the core of the entire system, which is mainly composed of the following five modules:

[0076] (1) Communication module: The communication module of the cloud server is responsible for establishing communication connections with remote clients and devices and handling two-way data transmission. This module may use a variety of communication protocols, such as HTTP, WebSocket, MQTT, etc., to adapt to different application scenarios and device types. Through the communication module, the remote client can send control instructions, task requests, data queries, etc. to the cloud server. At the same time, the cloud server can also actively send robot or device status information, execution results, etc. to the remote client.

[0077] (2) Data management module: The data management module is an important component of the cloud server. It is responsible for receiving, parsing, storing and indexing various data related to the robot or device. This includes the status information of the robot or device, task data, sensor data, execution logs, etc. The data management module stores data in a database, which can use a relational database (such as MySQL) or a NoSQL database (such as MongoDB). In order to improve the efficiency of data query and retrieval, the data management module will create an index and perform data backup and recovery to ensure data security and reliability.

[0078] (3) Control command processing module: The control command processing module is the core of the cloud server. It is responsible for processing control commands and task requests sent from remote clients. The module will parse and verify the received commands and requests, and then generate appropriate control logic according to the preset control algorithm. Once the processing is completed, the control command processing module will send the corresponding commands and tasks to the corresponding robot or device to execute the corresponding tasks.

[0079] (4) Device interface management module: Device interface management is an important part of the cloud server. It is responsible for managing the communication interface between each robot or device. Since different robots or devices may have different communication protocols and data formats, device interface management needs to implement the encapsulation and management of these device interfaces to ensure compatibility and stability with each device. This module is also responsible for device registration and deregistration, as well as message routing between devices.

[0080] (5) Security and permission control module: Cloud servers usually face challenges in data security and permission control. In order to ensure the confidentiality and integrity of data, cloud servers need to implement various security measures, such as data encryption, identity authentication, access control, etc. At the same time, in order to realize the permission control of different users on robots or devices, cloud servers also need to implement user permission management mechanisms to ensure that only authorized users can perform related operations.

[0081] 2. Remote client;

[0082] The remote client is an important part of the entire system. It communicates with the cloud server and provides users with an interface for operating robots and issuing tasks. The remote client consists of the following modules:

[0083] (1) User control interface: The user control interface is the main user interface of the remote client. Through this interface, the user can monitor the status of the robot in real time, control the robot to perform tasks, and issue new tasks. The interface is usually presented in a graphical form and provides an intuitive operation method, allowing users to easily interact with the robot.

[0084] (2) Communication module: The communication module is the core component for communication between the remote client and the cloud server. It is responsible for establishing and maintaining the network connection with the cloud server and sending and receiving data through the HTTP protocol. This module communicates with the cloud server by calling the API provided by the cloud server, including sending control instructions and tasks, and receiving the robot's status information.

[0085] (3) Data parsing module: The data parsing module is responsible for parsing the robot status information received from the cloud server. The cloud server may return the robot status data in JSON or other formats. The parsing module parses and analyzes this data to extract key information, such as the robot's position, speed, sensor data, etc. The parsed data will be passed to the user control interface for real-time display to the user so that the user can understand the robot's status.

[0086] (4) Task publishing module: The task publishing module allows users to publish new tasks to the cloud server. These tasks may be robot path planning, target setting, sensor acquisition, etc. Users can enter the relevant parameters and instructions of the task through the task publishing interface, and then send the task to the cloud server through the communication module. After receiving the task, the cloud server will assign the task to the corresponding robot instance according to the preset control algorithm, so that the robot can perform the task.

[0087] (5) Status monitoring module: The status monitoring module is an important function of the remote client. It allows users to monitor the status and operation of the robot in real time. The module will periodically request the robot's status information from the cloud server and display this information on the user control interface. Users can use the status monitoring module to understand the robot's current position, execution progress, sensor data, etc., and make corresponding controls and adjustments.

[0088] 3. Local client;

[0089] The local client includes the entire robot cluster, which consists of the following parts:

[0090] (1) Communication module:

[0091] The communication module of the robot cluster is a key component for achieving communication with the cloud server. This module is responsible for establishing a communication connection with the cloud server and handling two-way data transmission. Through the communication module, the robot cluster can receive control instructions and tasks from the control server, and at the same time feed back the robot's status information, execution results, and sensor data to the cloud server.

[0092] (2) Control logic and execution module:

[0093] The robot cluster needs to implement a complete set of control logic and task execution modules so that it can perform corresponding actions and behaviors according to the control instructions and tasks received from the cloud server. These control logics involve path planning, obstacle avoidance algorithms, control algorithms, etc. Through the control logic and execution modules, the robot cluster can perform tasks according to the instructions issued by the cloud server.

[0094] (3) Sensors, positioning systems, and cameras:

[0095] In order to achieve real-time status feedback, the robot cluster needs to be equipped with position and speed sensor modules and positioning systems. This module collects the robot's position and status information in real time and sends it to the cloud server through the communication module. In this way, the cloud server can monitor the robot's status in real time and make corresponding decisions and adjustments. The camera is used to obtain obstacle information so that the cloud can obtain a feasible route through trajectory planning.

[0096] (4) Data analysis and processing module:

[0097] The robot cluster may receive complex task instructions or data sent by the cloud server, so it is necessary to implement a data parsing and processing module to parse and process the data received from the cloud server. In this way, the robot cluster can accurately understand and execute the control logic sent by the cloud server.

[0098] (5) Local task management module:

[0099] The robot cluster has certain local task management capabilities. When the cloud server issues tasks, the robot cluster can queue or adjust the priority of tasks according to the actual situation to achieve reasonable task allocation and execution.

[0100] (6) Security module and recovery mechanism:

[0101] For the local client of the robot cluster, security and stability are also very important. The robot cluster has corresponding security measures to prevent unauthorized access or attacks. At the same time, in order to ensure the stability of the system, the robot cluster also has a self-recovery mechanism that can automatically handle and repair errors in the event of failures or abnormalities.

[0102] Optionally, controlling the robot to move along the desired trajectory according to the sliding mode control method and the robot disturbance information includes:

[0103] According to the sliding mode control method and the robot disturbance information, determine the position control law and the attitude control law of the robot, wherein the position control law is used to realize the robot tracking the position in the desired trajectory, and the attitude control law is used to realize the robot tracking the attitude angle in the desired trajectory;

[0104] A control instruction is sent to the robot, wherein the control instruction includes the position control law and the posture control law.

[0105] In the present application embodiment, Figure 3 As shown, first, the user queries the operating status and location information of each robot through a remote client (such as a PC client or mobile APP, etc.), and can turn the robot on and off through the remote APP, and can choose to join or exit the task queue. The user first activates the mobile robot through the APP, then adds tasks to the mobile robot, and transmits the tasks to the cloud server through the communication module.

[0106] Then, the current state and position information of the robot arm is obtained through the signal acquisition device integrated in the robot. The signal acquisition device here includes a positioning device, an inertial navigation system, a photoelectric encoder and other related sensors. Among them, the positioning device can obtain the real-time position information of the robot, the inertial navigation system can obtain the moving direction of the robot, and the photoelectric encoder collects the wheel speed of the robot. After the robot collects the current position, movement direction, and wheel speed, it encapsulates these data and sends them to the cloud server through the communication module.

[0107] Then, after receiving the task sent by the client and the status data such as the real-time position of the robot, the cloud server saves the data to the database and sends the current robot position, movement direction, wheel speed and other data to the remote client. At the same time, the control law of the robot (including the above-mentioned position control law v and posture control law w), that is, the control instruction, is obtained through the control algorithm, and the control instruction is sent to the corresponding robot.

[0108] Finally, after receiving the control command, the robot will first parse the control signal received from the cloud. The data is decoded into a format that the robot can understand in order to determine the specific task or action to be performed, and then the motor drives the rollers of the mobile robot to track the desired trajectory. If an obstacle is encountered during the execution of the task, the robot will transmit this information back to the cloud server, and then re-plan the path and control the mobile robot according to the new desired trajectory.

[0109] Optionally, determining the position control law and attitude control law of the robot according to the sliding mode control method and the robot disturbance information includes:

[0110] Determine a sliding surface function according to a fractional-order calculus operator and tracking error information of the robot, wherein the tracking error information includes position tracking error information and attitude angle tracking error information;

[0111] The position control law and the posture control law of the robot are determined according to the sliding surface function and the robot disturbance information.

[0112] In an embodiment of the present application, a fractional-order calculus operator is introduced into the sliding surface function. By adjusting the fractional order, the jitter of the controller can be significantly reduced. The fractional order has the characteristics of fast convergence and is insensitive to the influence of robustness. Therefore, the control algorithm of the present application can avoid the problem of robot jitter caused by controller vibration without losing the convergence speed and affecting the robustness.

[0113] In the embodiment of the present application, a control algorithm is designed based on a sliding mode control (SMC) method, and the specific process is as follows.

[0114] First, determine the dynamic model of the mobile robot. Take a mobile robot as an example. Its working diagram on the plane is as follows: Figure 4 As shown in the figure, (x, y) represents the current position of the robot, and θ is the current posture angle of the robot. These data are collected by the sensors and positioning devices in the robot, and sent to the cloud server through the communication module of the local client. (x d ,y d ) represents the destination that the robot needs to reach during the task. This data is determined by the task set by the user to the robot through the remote client. The cloud server will determine the robot's path based on the user's task and the trajectory planning algorithm, thereby determining the expected trajectory of the mobile robot. It can be determined that the dynamics of the mobile robot can be expressed as follows:

[0115]

[0116] Among them, d1 represents the robot disturbance value in the x-axis direction, d2 represents the robot disturbance value in the y-axis direction, and d3 represents the robot disturbance value in the robot posture angle direction; v is the position control law, and w is the posture control law. By designing these two control laws, the position (x, y) of the mobile robot can be tracked and the angle θ can be followed.

[0117] Optionally, the position tracking error information includes the tracking error x in the x-axis direction. e And the tracking error y in the y-axis direction e .x e =xx d ,y e =yy d .

[0118] Optionally, determining the position control law and attitude control law of the robot according to the sliding surface function and the robot disturbance information includes:

[0119] According to the robot disturbance information, the position error tracking equation and the attitude angle error tracking equation are obtained;

[0120] Determine the position control law of the robot according to the sliding surface function and the position error tracking equation;

[0121] Determine the attitude control law of the robot according to the sliding surface function and the attitude angle tracking method;

[0122] Wherein, the position error tracking equation satisfies the following formula:

[0123]

[0124] The attitude angle error tracking equation satisfies the following formula:

[0125]

[0126] Among them, x e represents the robot tracking error in the x-axis direction, y e represents the robot tracking error in the y-axis direction, d1 represents the robot disturbance value in the x-axis direction, d2 represents the robot disturbance value in the y-axis direction, θ represents the robot posture angle, x d represents the coordinate of the desired trajectory in the x-axis direction, y d represents the coordinate of the desired trajectory in the y-axis direction, and v represents the position control law;

[0127] θ e represents the robot posture angle tracking error, d3 represents the robot disturbance value in the robot posture angle direction, θ d represents the desired attitude angle, and w represents the attitude control law.

[0128] Optionally, the sliding surface function satisfies the following formula:

[0129] s=D α Δ+cI 1-α Sig r (Δ);

[0130] Where s represents the sliding surface, D α represents the α-order fractional differential operation, I 1-α represents the 1-α order fractional integral operation, α represents the fractional calculus operator, r and c are constants for adjusting convergence, and 0<α<1, 0 <r<1,c> 0;Sig r (Δ)=sgn(Δ)|Δ| r , Δ represents x e ,y e or θ e , x e represents the robot tracking error in the x-axis direction, y e represents the robot tracking error in the y-axis direction, θe represents the robot posture angle tracking error,

[0131] The above position control law is first explained as follows.

[0132] make

[0133] The sliding surface function is:

[0134] s1=D α x e +cI 1-α sig r (x e ) (4);

[0135] By taking the derivative of the above formula (4), we can get:

[0136]

[0137] The design fixed time reaching law is:

[0138]

[0139] Among them, 0<p<1, 0<q<1, and η is a constant.

[0140] Combining formulas (5) and (6) we can obtain:

[0141]

[0142] Where η>0, is the estimated value of d1, and the subsequent disturbance observer is designed to estimate its value in a finite time. The Lyapunov function is selected as Taking its derivative we get:

[0143]

[0144] According to the finite-time stability theory, the tracking error x e will converge to 0 in a finite time, that is, x→x d .

[0145] Similarly, for y e The designed fractional-order finite-time sliding surface is:

[0146] s2=D α y e +cI 1 - α sig r (y e ) (9);

[0147] Among them, the parameters are selected the same as s1, so we can get:

[0148]

[0149] in, is the observer's estimate of d2.

[0150] In order to make the designed controller satisfy (7) and (10), it is necessary to ensure Therefore, the desired posture angle of the robot is Then the actual position control law is

[0151] Next, we design the attitude control law w to ensure that the angle θ is equal to the desired angle θ d The tracking error θ e =θ-θ d , the error equation of the attitude subsystem is:

[0152]

[0153] The fractional-order finite-time sliding mode surface of the designed attitude subsystem is:

[0154] s3=D α θ e +cI 1-α sig r (θ e );

[0155] At the same time, the attitude control law involved is:

[0156]

[0157] in, is the observer's estimate of d3.

[0158] In sliding mode control, the switching function sgn(·) is a discontinuous function, which will cause serious chattering in the controller, causing vibration and noise in the mobile robot. At present, some studies usually use integral methods (integer-order calculus) to reduce controller chattering when designing controllers, but this is at the expense of the robustness of the controller and the rapid convergence of the system. The method of this proposal introduces fractional-order calculus operators into the design of sliding mode controllers. It can be seen from the control laws (7), (10), and (12) derived above that the control law performs fractional-order integral operations on the switching terms that cause chattering. By adjusting the fractional order, the controller chattering can be significantly reduced. The fractional order has the characteristics of rapid convergence and is insensitive to the influence of robustness. Therefore, the control algorithm of this proposal can avoid the vibration problem caused by the controller without losing the convergence speed and affecting the robustness.

[0159] Optionally, the method of the embodiment of the present application further includes:

[0160] The robot disturbance information is updated according to the tracking error information of the robot, the position control law and the posture control law.

[0161] In the embodiment of the present application, the initial robot disturbance information can be set. Then the robot disturbance information (disturbance value) is estimated by a finite time disturbance observer, and the estimated value is used in the controller designed above. Figure 3 As shown, the estimated value and Fractional-order finite-time controller for the position subsystem, The position subsystem fractional-order finite-time controller is used to output the position control law v, and the attitude subsystem fractional-order finite-time controller is used to output the attitude control law w.

[0162] Optionally, estimating the robot disturbance information according to the tracking error information of the robot, the position control law and the posture control law includes:

[0163] The robot disturbance information is estimated by the following formula:

[0164]

[0165] Among them, Z=[x yθ]; F(v,w,θ)=[v cosθv sinθw] T ;

[0166] R=[d1 d2 d3] T , Z=F(v,w,θ)+R,Z e =[x e y e θ e ] T ;

[0167] R represents the robot disturbance information, d1 represents the robot disturbance value in the x-axis direction, d2 represents the robot disturbance value in the y-axis direction, d3 represents the robot disturbance value in the robot posture angle direction, e represents the robot tracking error in the x-axis direction, y e represents the robot tracking error in the y-axis direction, θ e represents the robot's posture angle tracking error, w represents the posture control law, v represents the position control law, represents the robot's posture angle, k1, k2, k3 and k4 are all constants used to adjust the convergence.

[0168] In actual situations, the mobile robot will be affected by external disturbances during the execution of tasks, namely d1, d2, and d3 in formula (1). Next, a multidimensional finite-time disturbance observer is designed to estimate the disturbance value, and the estimated value will be used in the controller designed previously.

[0169] First, let Z = [x yθ] T , F(v,w,θ)=[v cosθv sinθw] T , R = [d1 d2 d3] T Then, formula (1) can be written as:

[0170]

[0171] The form of the designed observer is shown in formula (13).

[0172] Assume that the first-order derivative norm of the disturbance is bounded, that is, If the parameter selection satisfies condition (15), the disturbance estimation error will converge to 0 in a finite time.

[0173]

[0174] Here, δ represents a constant.

[0175] When there are multiple robots performing tasks, the cloud server will plan the desired trajectory for each robot, and then obtain the control logic of each robot based on the control algorithm designed above, and finally send it to the local client, which will be implemented by the robot's execution module (robot roller drive motor). Compared with traditional robot control, the control method based on the cloud server transfers the complex control algorithm calculation to the cloud, relying on the powerful computing power of the cloud platform to solve the problem of insufficient computing speed when multiple robots perform tasks at the same time, while reducing the cost of integrating high-performance controllers in the robot.

[0176] like Figure 5 As shown, the embodiment of the present application also provides a robot control device, which is applied to a cloud server, and the device includes:

[0177] The acquisition module 501 is used to acquire the task information sent by the remote client and the robot status information sent by the robot;

[0178] A determination module 502, configured to determine a desired trajectory of the robot according to the task information and the robot state information;

[0179] The control module 503 is used to control the robot to move along the desired trajectory according to a sliding mode control method and robot disturbance information, wherein the sliding mode control method is a control method related to fractional calculus.

[0180] Optionally, the control module includes:

[0181] A determination submodule, used to determine the position control law and the attitude control law of the robot according to the sliding mode control method and the robot disturbance information, wherein the position control law is used to realize the robot tracking the position in the desired trajectory, and the attitude control law is used to realize the robot tracking the attitude angle in the desired trajectory;

[0182] The sending submodule is used to send a control instruction to the robot, wherein the control instruction includes the position control law and the posture control law.

[0183] Optionally, the determining submodule includes:

[0184] A first determining unit is used to determine a sliding surface function according to a fractional-order calculus operator and tracking error information of the robot, wherein the tracking error information includes position tracking error information and attitude angle tracking error information;

[0185] The second determination unit is used to determine the position control law and the posture control law of the robot according to the sliding surface function and the robot disturbance information.

[0186] Optionally, the second determining unit includes:

[0187] An acquisition subunit is used to acquire a position error tracking equation and a posture angle error tracking equation according to the robot disturbance information;

[0188] A first determination subunit is used to determine the position control law of the robot according to the sliding surface function and the position error tracking equation;

[0189] A second determination subunit is used to determine the posture control law of the robot according to the sliding surface function and the posture angle tracking method;

[0190] Wherein, the position error tracking equation satisfies the following formula:

[0191]

[0192] The attitude angle error tracking equation satisfies the following formula:

[0193]

[0194] Among them, x e represents the robot tracking error in the x-axis direction, y e represents the robot tracking error in the y-axis direction, d1 represents the robot disturbance value in the x-axis direction, d2 represents the robot disturbance value in the y-axis direction, θ represents the robot posture angle, x drepresents the coordinate of the desired trajectory in the x-axis direction, y d represents the coordinate of the desired trajectory in the y-axis direction, and v represents the position control law;

[0195] θ e represents the robot posture angle tracking error, d3 represents the robot disturbance value in the robot posture angle direction, θ d represents the desired attitude angle, and w represents the attitude control law.

[0196] Optionally, the sliding surface function satisfies the following formula:

[0197] s=D α Δ+cI 1-α Sig r (Δ);

[0198] Where s represents the sliding surface, D α represents the α-order fractional differential operation, I 1-α represents the 1-α order fractional integral operation, α represents the fractional calculus operator, r and c are constants for adjusting convergence, and 0<α<1, 0 <r<1,c> 0;Sig r (Δ)=sgn(Δ)|Δ| r , Δ represents x e ,y e or θ e , x e represents the robot tracking error in the x-axis direction, y e represents the robot tracking error in the y-axis direction, θ e represents the robot posture angle tracking error,

[0199] Optionally, the device of the embodiment of the present application further includes:

[0200] The estimation module is used to estimate the robot disturbance information according to the tracking error information of the robot, the position control law and the posture control law.

[0201] Optionally, estimating the robot disturbance information according to the tracking error information of the robot, the position control law and the posture control law includes:

[0202] The robot disturbance information is estimated by the following formula:

[0203]

[0204] Among them, Z=[x yθ]; F(v,w,θ)=[v cosθv sinθw] T ;

[0205] R=[d1 d2 d3] T, Z=F(v,w,θ)+R,Z e =[x e y e θ e ] T ;

[0206] R represents the robot disturbance information, d1 represents the robot disturbance value in the x-axis direction, d2 represents the robot disturbance value in the y-axis direction, d3 represents the robot disturbance value in the robot posture angle direction, e represents the robot tracking error in the x-axis direction, y e represents the robot tracking error in the y-axis direction, θ e represents the robot's posture angle tracking error, w represents the posture control law, v represents the position control law, represents the robot's posture angle, k1, k2, k3 and k4 are all constants used to adjust the convergence.

[0207] In the above scheme of the embodiment of the present application, the cloud server obtains the task information sent by the remote client and the robot state information sent by the robot; determines the desired trajectory of the robot according to the task information and the robot state information; controls the robot to move along the desired trajectory according to the sliding mode control method and the robot disturbance information. In the above scheme, the cloud server controls the control trajectory of the peer robot without occupying the local resources of the robot to track and control the robot. Since the cloud service has powerful computing power, in the above scheme, fractional calculus is introduced into the partition control method. By adjusting the fractional order, the controller jitter can be significantly reduced. The fractional order has the characteristics of fast convergence and is insensitive to the influence of robustness. Therefore, the control algorithm of the present application can avoid the problem of robot jitter caused by controller vibration without losing the convergence speed and affecting the robustness.

[0208] An embodiment of the present application also provides a robot control system, comprising: a cloud server, a remote client and at least one robot respectively communicating with the cloud server, and the cloud server is used to execute the steps of the robot control method as described above.

[0209] like Figure 6 As shown, a robot control device according to an embodiment of the present application includes a processor 610 and a transceiver 620, wherein:

[0210] The transceiver is used to obtain task information sent by the remote client and robot status information sent by the robot;

[0211] The processor is used to determine the desired trajectory of the robot according to the task information and the robot state information; and control the robot to move along the desired trajectory according to a sliding mode control method and robot disturbance information, wherein the sliding mode control method is a control method related to fractional calculus.

[0212] It should be noted that the device is a device corresponding to the above-mentioned method embodiment. All implementation methods of the above-mentioned method embodiment can be applied to the device embodiment and can achieve the same technical effect, which will not be repeated here.

[0213] like Figure 7 As shown, an embodiment of the present application also provides a robot control device, including: a transceiver 710, a processor 700, a memory 720, and a program or instruction stored in the memory 720 and executable on the processor 700; when the processor 700 executes the program or instruction, the steps of the robot control method as described above are implemented.

[0214] The transceiver 710 is used to receive and send data under the control of the processor 700.

[0215] Among them, Figure 7 In the embodiment, the bus architecture may include any number of interconnected buses and bridges, specifically one or more processors represented by processor 700 and various circuits of memory represented by memory 720 are linked together. The bus architecture may also link together various other circuits such as peripherals, voltage regulators, and power management circuits, which are well known in the art and are therefore not further described herein. The bus interface provides an interface. The transceiver 710 may be a plurality of components, namely, a transmitter and a receiver, providing a unit for communicating with various other devices on a transmission medium. For different user devices, the user interface 730 may also be an interface capable of externally and internally connecting required devices, and the connected devices include but are not limited to a keypad, a display, a speaker, a microphone, a joystick, and the like.

[0216] The processor 700 is responsible for managing the bus architecture and general processing, and the memory 720 can store data used by the processor 700 when performing operations.

[0217] An embodiment of the present application also provides a readable storage medium on which a program or instruction is stored. When the program or instruction is executed by a processor, the steps in the robot control method as described above are implemented and the same technical effect can be achieved. To avoid repetition, it will not be repeated here.

[0218] The processor is the processor in the robot control device described in the above embodiment. The readable storage medium includes a computer readable storage medium, such as a computer read-only memory (ROM), a random access memory (RAM), a magnetic disk or an optical disk.

[0219] An embodiment of the present application also provides a computer program product, including computer instructions, which implement the steps of the robot control method as described above when executed by a processor.

[0220] It should be further explained that the terminals described in this specification include but are not limited to smart phones, tablet computers, etc., and many of the functional components described are called modules in order to more particularly emphasize the independence of their implementation methods.

[0221] In the embodiment of the present application, module can be implemented with software so that it can be executed by various types of processors. For example, an executable code module of an identification can include one or more physical or logical blocks of computer instructions, for example, it can be constructed as an object, process or function. Nevertheless, the executable code of the identified module does not need to be physically located together, but can include different instructions stored in different positions, and when these instructions are logically combined together, it constitutes a module and realizes the specified purpose of the module.

[0222] In fact, executable code module can be a single instruction or many instructions, and can even be distributed on a plurality of different code segments, distributed among different programs, and distributed across a plurality of memory devices. Similarly, operating data can be identified in the module, and can be implemented and organized in the data structure of any appropriate type according to any appropriate form. The operating data can be collected as a single data set, or can be distributed in different locations (including on different storage devices), and can only be present on a system or network as an electronic signal at least in part.

[0223] When a module can be implemented by software, considering the level of existing hardware technology, a person skilled in the art can build a corresponding hardware circuit to implement the corresponding function of the module that can be implemented by software without considering the cost. The hardware circuit includes a conventional very large scale integration (VLSI) circuit or gate array and existing semiconductors such as logic chips, transistors, or other discrete components. The module can also be implemented by a programmable hardware device, such as a field programmable gate array, a programmable array logic, a programmable logic device, etc.

[0224] The above exemplary embodiments are described with reference to the accompanying drawings, and many different forms and embodiments are feasible without departing from the spirit and teachings of the present application. Therefore, the present application should not be constructed as a limitation of the exemplary embodiments proposed herein. More specifically, these exemplary embodiments are provided so that the present application will be perfect and complete, and the scope of the present application will be conveyed to those who are familiar with the technology. In these figures, the component sizes and relative sizes may be exaggerated for clarity. The terms used here are only based on the purpose of describing specific exemplary embodiments and are not intended to be limiting. As used herein, unless the text clearly indicates otherwise, the singular forms "one", "an" and "the" are intended to include these multiple forms. It will be further understood that the terms "comprising" and / or "including" when used in this specification indicate the presence of the features, integers, steps, operations, components and / or components, but do not exclude the presence or increase of one or more other features, integers, steps, operations, components, components and / or their groups. Unless otherwise indicated, when stated, a range of values ​​includes the upper and lower limits of that range and any subranges therebetween.

[0225] The above is a preferred embodiment of the present application. It should be pointed out that for ordinary technicians in this technical field, several improvements and modifications can be made without departing from the principles described in the present application. These improvements and modifications should also be regarded as the scope of protection of the present application.

Claims

1. A robot control method, characterized in that: Applied to a cloud server, the method comprises: Get the task information sent by the remote client and the robot status information sent by the robot; Determining a desired trajectory of the robot according to the task information and the robot state information; According to the sliding mode control method and the robot disturbance information, the robot is controlled to move along the desired trajectory, and the sliding mode control method is a control method related to fractional calculus.

2. The method according to claim 1, characterized in that The step of controlling the robot to move along the desired trajectory according to the sliding mode control method and the robot disturbance information includes: According to the sliding mode control method and the robot disturbance information, determine the position control law and the attitude control law of the robot, wherein the position control law is used to realize the robot tracking the position in the desired trajectory, and the attitude control law is used to realize the robot tracking the attitude angle in the desired trajectory; A control instruction is sent to the robot, wherein the control instruction includes the position control law and the posture control law.

3. The method according to claim 2, characterized in that Determining the position control law and attitude control law of the robot according to the sliding mode control method and the robot disturbance information includes: Determine a sliding surface function according to a fractional-order calculus operator and tracking error information of the robot, wherein the tracking error information includes position tracking error information and attitude angle tracking error information; The position control law and the posture control law of the robot are determined according to the sliding surface function and the robot disturbance information.

4. The method according to claim 3, characterized in that Determining the position control law and the posture control law of the robot according to the sliding surface function and the robot disturbance information includes: According to the robot disturbance information, the position error tracking equation and the attitude angle error tracking equation are obtained; Determine the position control law of the robot according to the sliding surface function and the position error tracking equation; Determine the attitude control law of the robot according to the sliding surface function and the attitude angle tracking method; Wherein, the position error tracking equation satisfies the following formula: The attitude angle error tracking equation satisfies the following formula: Among them, x e represents the robot tracking error in the x-axis direction, y e represents the robot tracking error in the y-axis direction, d1 represents the robot disturbance value in the x-axis direction, d2 represents the robot disturbance value in the y-axis direction, θ represents the robot posture angle, x d represents the coordinate of the desired trajectory in the x-axis direction, y d represents the coordinate of the desired trajectory in the y-axis direction, and v represents the position control law; θ e represents the robot posture angle tracking error, d3 represents the robot disturbance value in the robot posture angle direction, θ d represents the desired attitude angle, and w represents the attitude control law.

5. The method according to claim 3 or 4, characterized in that: The sliding surface function satisfies the following formula: s=D α Δ+cI 1-α Mr r (Δ); Where s represents the sliding surface, D α represents the α-order fractional differential operation, I 1-α represents the 1-α order fractional integral operation, α represents the fractional calculus operator, r and c are constants for adjusting convergence, and 0<α<1, 0 <r<1,c> 0;Sig r (Δ)=sgn(Δ)|Δ| r , Δ represents x e ,y e or θ e , x e represents the robot tracking error in the x-axis direction, y e represents the robot tracking error in the y-axis direction, θ e represents the robot posture angle tracking error, 6. The method according to claim 2, characterized in that Also includes: The robot disturbance information is estimated according to the tracking error information of the robot, the position control law and the posture control law.

7. The method according to claim 6, characterized in that According to the tracking error information of the robot, the position control law and the posture control law, the disturbance information of the robot is estimated, including: The robot disturbance information is estimated by the following formula: Where, Z=[x yθ];F(v,w,θ)=[v cosθv sinθw] T ; R=[d1 d2 d3] T ,Z=F(v,w,θ)+R,Z e =[x e y e θ e ] T ; R represents the robot disturbance information, d1 represents the robot disturbance value in the x-axis direction, d2 represents the robot disturbance value in the y-axis direction, d3 represents the robot disturbance value in the robot posture angle direction, e represents the robot tracking error in the x-axis direction, y e represents the robot tracking error in the y-axis direction, θ e represents the robot's posture angle tracking error, w represents the posture control law, v represents the position control law, represents the robot's posture angle, k1, k2, k3 and k4 are all constants used to adjust the convergence.

8. A robot control device, characterized in that: Applied to a cloud server, the device comprises: The acquisition module is used to obtain the task information sent by the remote client and the robot status information sent by the robot; A determination module, used to determine the expected trajectory of the robot according to the task information and the robot state information; A control module is used to control the robot to move along the desired trajectory according to a sliding mode control method and robot disturbance information, wherein the sliding mode control method is a control method related to fractional calculus.

9. A robot control device, characterized in that: include: transceivers and processors; The transceiver is used to obtain task information sent by the remote client and robot status information sent by the robot; The processor is used to determine the desired trajectory of the robot according to the task information and the robot state information; and control the robot to move along the desired trajectory according to a sliding mode control method and robot disturbance information, wherein the sliding mode control method is a control method related to fractional calculus.

10. A robot control system, characterized in that: include: A cloud server, a remote client and at least one robot communicating with the cloud server respectively, and the cloud server is used to execute the steps of the robot control method as described in any one of claims 1 to 7.

11. A computer-readable storage medium, characterized in that: A computer program is stored on a computer-readable storage medium, and when the computer program is executed by a processor, the steps of the robot control method according to any one of claims 1 to 7 are implemented.

12. A computer program product, characterized in that The method comprises computer instructions, which, when executed by a processor, implement the steps of the robot control method according to any one of claims 1 to 7.