Robot adaptive tracking control method and device under limited field of view constraints

By designing the initial controller under field of view constrained by robot kinematics and least squares identification, and updating parameters through event trigger rules, the problem of conflict between task objectives and safety constraints in robot adaptive tracking control is solved, and the problem of conflict between task objectives and safety constraints in robot adaptive tracking control is realized. Improve the stability and robustness of the system.

CN118550200BActive Publication Date: 2024-11-15HANGZHOU INNOVATION RES INST OF BEIJING UNIV OF AERONAUTICS & ASTRONAUTICS +1
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411017285.X
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-07-29
Publication Date
2024-11-15
Estimated Expiration
2044-07-29

AI Technical Summary

Technical Problem

In the prior art, under the condition of limited field of view, it is difficult for robot adaptive tracking control systems to effectively handle the conflict between task objectives and safety constraints, and the impact of unknown parameters on system stability and robustness is difficult to completely eliminate.

Method used

By determining the motion model based on robot kinematics, combining the least squares identification method to determine the unknown parameters of the initial controller, and using the control Liyapunov function and the control obstacle function to design the initial controller, the event triggering rule is used to update the parameters to ensure that the target always Adaptive tracking control is performed within the robot's field of view.

Benefits of technology

After a limited number of parameter updates, the impact of unknown parameters on the adaptive tracking control system is eliminated, the stability and robustness of the system are improved, and the effective tracking of the targets and the satisfaction of security constraints is ensured.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118550200B_ABST
    Figure CN118550200B_ABST
Patent Text Reader

Abstract

The embodiments of this specification provide a method and device for adaptive tracking control of a robot under a limited field of view constraint, wherein the method comprises: determining a motion model based on the robot kinematics, and determining an initial controller under the limited field of view constraint based on the motion model; determining unknown parameters of the initial controller based on least squares identification; determining a target controller based on the unknown parameters and the initial controller, and adaptively tracking the robot based on the target controller. By determining a motion model based on the robot kinematics, and determining an initial controller under the limited field of view constraint based on the motion model; determining unknown parameters of the initial controller based on least squares identification; determining a target controller based on the unknown parameters and the initial controller, and adaptively tracking the robot based on the target controller, the least squares parameter identification adopted can eliminate the influence of parameter uncertainty on the adaptive tracking control system after a finite number of parameter updates.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The embodiments of this specification relate to the field of robotics technology, and in particular to a robot adaptive tracking control method under a limited field of view constraint. Background Art

[0002] Adaptive tracking control methods are an important part of the field of intelligent mobile robot control. In the field of mobile robots, adaptive tracking control systems need to consider the constraints of limited field of view. Limited field of view means that the sensors on the robot (such as cameras, fisheye cameras, etc.) can only obtain information within a limited range. This constraint is very important in practical applications because the robot can only rely on the information obtained by the sensors to perceive the surrounding environment and make appropriate control decisions.

[0003] In recent years, in order to solve the problem of limited field of view, researchers have conducted a lot of related investigations, such as radar sensors (Chen 2021 CIE ICR) and fisheye cameras (Cai 2022 PhotonicsTechnol. Lett.). However, these two methods will greatly increase the calculation time, which will lead to a decrease in control accuracy and even errors. Related research (Chesi 2004 TR) uses control switching strategies to ensure that the target always exists in the field of view, but the design of potential functions and switching rules is very difficult.

[0004] In order to deal with the potential conflict between the mission goal (tracking the target) and the safety constraint (keeping the target always within the field of view) of the intelligent robot during driving, the relevant research (Ames 2017 TAC) first converted the mission goal and safety constraint into the control Lyapunov function (CLF) and the control barrier function (CBF). Then, by setting different priorities for CLF and CBF, it is ensured that the safety constraint can be satisfied first when dealing with conflicts. Finally, the controller is designed based on the quadratic program (QP) to solve the control signal online.

[0005] Since there are many uncertainties in the robot model parameters and it is difficult to obtain accurate parameter values, many studies in recent decades have been devoted to estimating the true values ​​of the parameters to reduce the impact of unknown parameters on the overall control, ensure the overall stability of the adaptive system, and enhance the overall robustness. Related studies (Adetola 2014 TAC) use the projection operator adaptive control method based on Lyapunov theory to estimate uncertain parameters, and introduce the estimated values ​​into CLF and CBF to suppress the impact of parameter uncertainty. In some studies (Parikh 2019, Isaly 2021 ACC), a data-based algorithm of CL (concurrent learning) is proposed to improve the adaptive law to ensure the boundedness of the parameter estimates. However, the adaptive laws of the above studies have the phenomenon of over-parameterization, that is, the number of parameter estimates exceeds the number of unknown parameters, and these methods only ensure the boundedness of parameter estimates, and cannot fully estimate the parameters to the true value, nor can they completely eliminate the impact of unknown parameters on the adaptive tracking control system.

[0006] Therefore, a better solution is urgently needed. Summary of the invention

[0007] In view of this, the embodiments of this specification provide a robot adaptive tracking control method under the constraint of limited field of view. One or more embodiments of this specification also relate to a robot adaptive tracking control device under the constraint of limited field of view, a computing device, a computer readable storage medium and a computer program to solve the technical defects existing in the prior art.

[0008] According to a first aspect of an embodiment of this specification, there is provided a robot adaptive tracking control method under a field of view restriction constraint, comprising:

[0009] Determine a motion model based on robot kinematics, and determine an initial controller under field of view constraints based on the motion model;

[0010] Determine the unknown parameters of the initial controller based on least squares identification;

[0011] The target controller is determined based on the unknown parameters and the initial controller, and the robot is adaptively tracked based on the target controller.

[0012] In a possible implementation, determining a motion model based on robot kinematics includes:

[0013] Determine the initial model based on the robot kinematics;

[0014] Determine the velocity relationship of the robot based on its geometry;

[0015] A motion model is determined based on the velocity relationship and the initial model.

[0016] In a possible implementation, determining an initial controller under a field of view restriction constraint based on a motion model includes:

[0017] Determine the mission objective equation and safety constraint equation under the field of view restriction constraint;

[0018] Determine the control obstacle function and the control Lyapunov function based on the mission objective equation and the field of view constraint equation;

[0019] The initial controller is determined based on the control obstacle function and the control Lyapunov function.

[0020] In a possible implementation, the unknown parameters of the initial controller are determined based on least squares identification, including:

[0021] Determine a deformation state equation based on the motion model, and integrate the deformation state equation in a first time period to determine a first integrated state equation;

[0022] Determining a second integrated state equation based on the integration of the integrated state equation during the second time period;

[0023] Determining an offline parameter update law based on the second integral state equation;

[0024] The unknown parameters are determined based on the offline parameter update law.

[0025] In a possible implementation, the method further includes:

[0026] An update parameter is determined based on a preset rule, and a target controller is updated based on the update parameter to obtain an update controller, and adaptive tracking control is performed on the robot based on the update controller.

[0027] In a possible implementation, determining the update parameter based on a preset rule includes:

[0028] In the case of adaptive tracking control of the robot based on the target controller, when the unknown parameter exceeds the safety warning value, the unknown parameter is updated to determine the updated parameter.

[0029] In a possible implementation, determining the update parameter based on a preset rule includes:

[0030] Determine a preset update time, update the unknown parameters based on the preset update time, and determine the update parameters.

[0031] According to a second aspect of the embodiments of this specification, there is provided a robot adaptive tracking control device under field of view restriction constraints, comprising:

[0032] A model determination module is configured to determine a motion model based on robot kinematics, and determine an initial controller under field of view restriction constraints based on the motion model;

[0033] a parameter estimation module configured to determine unknown parameters of an initial controller based on least squares identification;

[0034] The tracking control module is configured to determine a target controller based on unknown parameters and an initial controller, and to perform adaptive tracking control on the robot based on the target controller.

[0035] According to a third aspect of an embodiment of this specification, a computing device is provided, including:

[0036] Memory and processor;

[0037] The memory is used to store computer executable instructions, and the processor is used to execute the computer executable instructions. When the computer executable instructions are executed by the processor, the steps of the robot adaptive tracking control method under the constraint of limited field of view are implemented.

[0038] According to a fourth aspect of the embodiments of this specification, a computer-readable storage medium is provided, which stores computer-executable instructions, which, when executed by a processor, implement the steps of the above-mentioned robot adaptive tracking control method under the constraint of limited field of view.

[0039] According to a fifth aspect of the embodiments of this specification, a computer program is provided, wherein when the computer program is executed in a computer, the computer is caused to execute the steps of the above-mentioned robot adaptive tracking control method under the constraint of limited field of view.

[0040] The embodiments of this specification provide a method and device for adaptive tracking control of a robot under a limited field of view constraint, wherein the method comprises: determining a motion model based on the robot kinematics, and determining an initial controller under the limited field of view constraint based on the motion model; determining unknown parameters of the initial controller based on least squares identification; determining a target controller based on the unknown parameters and the initial controller, and adaptively tracking the robot based on the target controller. By determining a motion model based on the robot kinematics, and determining an initial controller under the limited field of view constraint based on the motion model; determining unknown parameters of the initial controller based on least squares identification; determining a target controller based on the unknown parameters and the initial controller, and adaptively tracking the robot based on the target controller, the least squares parameter identification adopted can eliminate the influence of parameter uncertainty on the adaptive tracking control system after a finite number of parameter updates. BRIEF DESCRIPTION OF THE DRAWINGS

[0041] Figure 1is a flow chart of a robot adaptive tracking control method under field of view restriction provided by one embodiment of this specification;

[0042] Figure 2 It is a schematic diagram of a model in a global coordinate system of a robot adaptive tracking control method under a limited field of view constraint provided by an embodiment of this specification;

[0043] Figure 3 It is a schematic diagram of a model in a local coordinate system of a robot adaptive tracking control method under a limited field of view constraint provided by an embodiment of this specification;

[0044] Figure 4 is a tracking trajectory diagram of a robot adaptive tracking control method under field of view restriction provided by an embodiment of the present specification;

[0045] Figure 5 is a tracking error diagram of a robot adaptive tracking control method under field of view restriction provided by an embodiment of the present specification;

[0046] Figure 6 is a view angle variation diagram of a robot adaptive tracking control method under field of view restriction provided by an embodiment of this specification;

[0047] Figure 7a is a first parameter update diagram of a robot adaptive tracking control method under field of view restriction constraint provided by an embodiment of this specification;

[0048] Figure 7b is a first parameter update diagram of a robot adaptive tracking control method under field of view restriction constraint provided by an embodiment of this specification;

[0049] Figure 8 It is a schematic diagram of the structure of a robot adaptive tracking control device under field of view restriction provided by one embodiment of the present specification;

[0050] Fig. 9 It is a structural block diagram of a computing device provided by an embodiment of this specification. DETAILED DESCRIPTION

[0051] Many specific details are described in the following description to facilitate a full understanding of this specification. However, this specification can be implemented in many other ways than those described herein, and those skilled in the art can make similar generalizations without violating the connotation of this specification, so this specification is not limited to the specific implementation disclosed below.

[0052] The terms used in one or more embodiments of this specification are only for the purpose of describing specific embodiments, and are not intended to limit one or more embodiments of this specification. The singular forms of "a" and "the" used in one or more embodiments of this specification and the appended claims are also intended to include plural forms, unless the context clearly indicates other meanings. It should also be understood that the term "and / or" used in one or more embodiments of this specification refers to and includes any or all possible combinations of one or more associated listed items.

[0053] It should be understood that although the terms first, second, etc. may be used to describe various information in one or more embodiments of this specification, this information should not be limited to these terms. These terms are only used to distinguish the same type of information from each other. For example, without departing from the scope of one or more embodiments of this specification, the first may also be referred to as the second, and similarly, the second may also be referred to as the first. Depending on the context, the word "if" as used herein may be interpreted as "at the time of" or "when" or "in response to determining".

[0054] First, the terms involved in one or more embodiments of this specification are explained.

[0055] Symbols meaning: The set of real numbers, The set of positive real numbers, The set of negative real numbers

[0056] Class Functions : In the domain Satisfies strictly increasing, and

[0057] Class Functions : In the domain Satisfies strictly increasing, and ,when hour,

[0058] Extensions Class Functions , in the domain Satisfies strictly increasing, and ,when hour, ,when hour,

[0059] In this specification, a robot adaptive tracking control method under limited field of view constraints is provided. This specification also relates to a robot adaptive tracking control device under limited field of view constraints, a computing device, and a computer-readable storage medium, which are described in detail one by one in the following embodiments.

[0060] See also Figure 1 , Figure 1 A flowchart of a robot adaptive tracking control method under field of view limitation constraints provided according to an embodiment of the present specification is shown, which specifically includes the following steps.

[0061] Step 101: Determine a motion model based on robot kinematics, and determine an initial controller under field of view constraints based on the motion model.

[0062] In a possible implementation, determining a motion model based on robot kinematics includes: determining an initial model based on robot kinematics; determining a velocity relationship of the robot based on a geometric structure of the robot; and determining a motion model based on the velocity relationship and the initial model.

[0063] In practical applications, adaptive tracking control methods based on event-triggered identifiers are used. We consider the case where a mobile robot tracks a target when its field of view is limited, such as Figure 2 As shown, according to the robot kinematics, its model can be obtained as follows:

[0064] (1)

[0065] in, is the coordinate of the robot in the global coordinate system, is the robot speed direction and The angle of the axis. and are the linear velocity and angular velocity of the robot in the global coordinate system. According to the robot's geometric structure, the relationship between its velocity and angular velocity and the angular velocity of the wheels is as follows:

[0066] (2)

[0067] Represent the angular velocities of the right and left wheels respectively. Represents the distance between the two wheels of the robot, Represents the wheel radius, these two parameters are unknown parameters in the mobile robot model. Order:

[0068] (3)

[0069] Represents unknown parameters, The comprehensive motion model of the two-wheel underactuated robot is:

[0070] (4)

[0071] in , , .

[0072] In a possible implementation, determining an initial controller under a field of view restriction constraint based on a motion model includes: determining a task objective equation and a safety constraint equation under a field of view restriction constraint; determining a control obstacle function and a control Lyapunov function based on the task objective equation and the field of view constraint equation; and determining an initial controller based on the control obstacle function and the control Lyapunov function.

[0073] In practical applications, adaptive tracking control under limited field of view means that when the vehicle's line of sight is subject to certain constraints, the target to be tracked must always be within the robot's field of view, thereby achieving motion trajectory tracking of the target. Assume that the desired tracking distance is , the robot's maximum field of view is , the distance and angle between the robot and the target are , , then the task objective and field of view constraint of adaptive tracking control can be expressed by the following two equations

[0074] (5)

[0075] (6)

[0076] In this step, unknown parameters are not considered. In this case, the task objective and field of view constraint are respectively transformed into the following control Lyapunov function and control obstacle function. The specific methods are introduced below.

[0077] Choose a continuously differentiable control Lyapunov function ,and It means that the tracking control goal of the robot is achieved. is positive definite and radially unbounded, that is, there exists Class Functions and satisfy

[0078] (7)

[0079] in, represents the control error, This means that the robot successfully achieves the target tracking task. (For example, the control Lyapunov function can be selected as ). Select one Class Functions , then the control input that satisfies the following equation Smart vehicles will The characteristics of the task are achieved.

[0080] (8)

[0081] At a certain moment, the state of the intelligent robot is used to determine whether it violates the field of view constraint. All states that can satisfy the robot's field of view constraint constitute a set That is, if and only if , the robot does not violate the constraint. Then it is obvious that the robot's field of view constraint is equivalent to the set Forward invariance means that for any ,satisfy .

[0082] Construct a continuously differentiable function , and the set Satisfies the following relationship

[0083] (9)

[0084] (10)

[0085] (11)

[0086] in, and Table representation The boundary and interior of . (For example, the control barrier function can be chosen as ). Select an extension Class Functions , then the control input that satisfies the following equation Will ensure the safety of the robot,

[0087] (12)

[0088] Before designing the controller, it is necessary to introduce the robot's local motion coordinate system ,like Figure 3 As shown, the local kinematics then need to be modeled,

[0089]

[0090] (13)

[0091] in and yes exist and The projection below. and yes exist and Due to the limitation of the actual robot model, we can get , so the above formula can be simplified to:

[0092]

[0093] (14)

[0094] It represents the angle between the robot's line of sight and the target in the local coordinate system and is defined as follows:

[0095] (15)

[0096] Define the relative distance between the robot and the target as:

[0097] (16)

[0098] Combined with the local coordinate system model (14), we can get and The derivative of is expressed as follows, which prepares for the subsequent controller design.

[0099] (17)

[0100] (18)

[0101] Considering the situation where the task goal conflicts with the field of view constraint (no control signal At the same time, formulas (8) and (12) are satisfied), reducing the priority of the control Lyapunov function constraint, and the following controller is designed based on quadratic programming.

[0102] (19)

[0103] in , is a relaxation term used to reduce the priority of formula (8) to ensure the existence of the solution of formula (19). is a positive definite matrix, , and are two positive constants.

[0104] (20)

[0105] (twenty one)

[0106] (twenty two)

[0107] (twenty three)

[0108] if Known, we can use the CLF-CBF-QP controller of formula (19) to achieve a good adaptive tracking control effect. However, the embodiment of this specification considers The unknown situation makes it impossible to directly calculate the control input signal in real time according to (19) .

[0109] Step 102: Determine the unknown parameters of the initial controller based on least squares identification.

[0110] In one possible implementation, the unknown parameters of the initial controller are determined based on least squares identification, including: determining a deformation state equation based on a motion model, and integrating the deformation state equation in a first time period to determine a first integrated state equation; determining a second integrated state equation based on the integrated state equation integrated in a second time period; determining an offline parameter update law based on the second integrated state equation; and determining unknown parameters based on the offline parameter update law.

[0111] In practical applications, in order to obtain a controller that can calculate control signals in real time and achieve adaptive tracking effects, this step uses a parameter identifier based on batch least squares to estimate unknown parameters to compensate for their impact on the intelligent mobile robot system. Before the formal design, it is necessary to first transform the state equation of the system and rewrite it into the following form:

[0112] (twenty four)

[0113] in , , It should be noted that In the function, all values ​​are available.

[0114] Apply formula (24) to the time period Points can be obtained

[0115] (25)

[0116] For any ,definition

[0117] (26)

[0118] (27)

[0119] Then formula (25) can be further written as

[0120] (28)

[0121] Formula (28) is multiplied on the left by Available

[0122] (29)

[0123] Formula (29) and In time period Points can be obtained

[0124] (30)

[0125] in

[0126] (31)

[0127] (32)

[0128] Design the offline parameter update law based on quadratic programming as follows

[0129]

[0130] (33)

[0131] in, and Respectively in and The parameter estimate calculated based on historical data at each moment. From formula (33), we can know yes In the linear equality constraints The projection onto the described hyperplane.

[0132] In formula (19), the parameter estimate Substituting for unknown parameters , that is, the adaptive tracking controller of the embodiment of this specification is obtained

[0133]

[0134] (34)

[0135] It should be emphasized that the parameter update law designed in this paper is different from previous studies, that is, it is not aimed at estimating the true value of the unknown parameter, but at eliminating the impact of the unknown parameter on the system. Even if the parameter estimate satisfies .

[0136] The parameter estimation method used in the CLF-CBF-QP controller in the embodiments of this specification is designed not to ensure the specific properties of the derivative of the control Lyapunov function, but to directly estimate the unknown parameters using the historical data of the system. This can ensure the boundedness of the parameter estimation and the stability of the adaptive tracking control system. By converting the tracking target and the field of view constraint into CLF and CBF respectively, the potential conflict between the two is successfully resolved, and the ideal tracking effect is achieved.

[0137] Step 103: Determine a target controller based on the unknown parameters and the initial controller, and perform adaptive tracking control on the robot based on the target controller.

[0138] Furthermore, it also includes: determining update parameters based on preset rules, and updating the target controller based on the update parameters to obtain an updated controller, and performing adaptive tracking control on the robot based on the updated controller.

[0139] In practical applications, the above unknown parameters may be inaccurate as the system runs, so the parameters need to be updated in a timely manner. Specifically, the parameter update can be performed in the following two ways.

[0140] In a possible implementation, the update parameters are determined based on preset rules, including: when the robot is adaptively tracked and controlled based on the target controller, when the unknown parameters exceed the safety warning value, the unknown parameters are updated to determine the update parameters.

[0141] In another possible implementation, determining the update parameter based on a preset rule includes: determining a preset update time, updating the unknown parameter based on the preset update time, and determining the update parameter.

[0142] The (33) proposed in the previous step is an offline parameter identifier that needs to be is activated (triggered). In this adaptive tracking system, ensuring that the target is always within the robot's field of view is more important than tracking the target, so we design event triggering rules based on the safety level of the system, that is, triggering the parameter update law when the system state tends to the dangerous range. The update time of the trigger condition is determined by the following conditions

[0143] (35)

[0144] in is a positive integer representing the maximum trigger time interval. represents moments when the adaptive system performs poorly, The definition is as follows

[0145] (36)

[0146] in is a safety warning value that limits the impact of unknown parameters to a predefined set. Define a set of auxiliary signals Record the trigger reason.

[0147] (37)

[0148] In order to avoid the parameter update law (33) being triggered infinitely many times in a finite time, is selected to have the following form with the attenuation characteristic (38)

[0149] (38)

[0150] in and are two constants.

[0151] At this point, the design of the adaptive tracking controller of the embodiment of this specification is completed. In the implementation process, the parameter estimation value obtained by solving formula (33) offline at a certain triggering time is substituted into formula (34), and the control input signal of the intelligent vehicle is calculated by formula (34) , and calculate the new parameter estimate through formula (33) when the event triggering rule (35) is triggered.

[0152] When the adaptive tracking control method provided in the embodiment of this specification is adopted, a certain triggering moment The parameter estimates obtained by the parameter update law (33) Possibly The same, or different. Without loss of generality, if The value of has changed when running the parameter update law (33), and we say that the parameter estimate has been updated once. It is worth noting that the parameter estimate The number of updates will not exceed the dimension of the space where the unknown parameters are located. , let's take the parameter estimates The last time it was updated is recorded as This control method will ensure , and then the control signal calculated by formula (19) and formula (34) will be exactly the same, that is, the influence of unknown parameters on the adaptive tracking control system will be After a moment, it is completely eliminated. , , that is, the linear velocity is only related to The angular velocity is only related to So if In the case of insufficient excitation, that is, the mobile robot always goes straight without turning, There is a possibility that recognition may not be possible.

[0153] exist Before the time, the event triggering rule (35) will ensure that , that is, to ensure that the target is always within the robot's field of view and does not exceed the robot's sight angle. After time, the quadratic programming controller (34) will ensure that This ensures that the collection forward invariance.

[0154] In summary, the adaptive tracking control algorithm proposed in the embodiments of this specification can well track the target and always keep the target within the robot's line of sight when there are uncertain parameters in the robot's motion model.

[0155] Furthermore, in order to verify the effectiveness of the adaptive tracking control method based on event-triggered identifier when the field of view is limited, a controller is designed for a specific intelligent mobile robot model, and simulation experiments are carried out in Matlab for the implementation case.

[0156] (1) Parameter setting

[0157] Target track ahead:

[0158]

[0159]

[0160] Table 1 Intelligent vehicle parameters and initial state

[0161]

[0162] Table 2 Parameters of controller and identifier

[0163]

[0164] (2) Results Analysis

[0165] The simulation results are as follows Figure 4-7b shown.

[0166] The analysis results show that, under the constraint of limited field of view of the intelligent mobile robot, the adaptive tracking control method based on event-triggered identifier proposed in the present invention can coordinate the conflict between the tracking target and the safety constraints well and complete the adaptive tracking task when there are unknown parameters in the intelligent mobile robot model. Figure 4It shows the tracking trajectory diagram, the dotted line represents the target trajectory, and the solid line represents the actual trajectory of the robot. Figure 5 represents the tracking error, Figure 6 Indicates the robot's field of view. The two dotted lines represent the upper and lower limits of the field of view, and the solid line represents the robot's actual line of sight. Figure 7a and Figure 7b The trends of parameter estimates over time are given.

[0167] according to Figure 4 It can be seen that the robot can track the trajectory of the target very well. Figure 5 It can be seen that the distance between the two vehicles was set to 0.2m at the initial moment, and the tracking error converged to 0 in a very short time (about 5 seconds), ensuring the completion of the mission goal. Figure 6 It can be seen that the robot's sight angle is always maintained within the given upper and lower limits, and does not exceed them, so there is no violation of the safety constraints. Figure 7a and 7b , the horizontal axis is time in seconds, and the vertical axis is the parameter value; according to Figure 7a It can be seen that the parameter estimator is triggered at 5.1 seconds and estimates the unknown parameters The true value of Figure 7b It can be seen that the parameter estimator is triggered at 5.1 seconds and estimates the unknown parameters The true value of , thereby completely eliminating the influence of unknown parameters on the adaptive tracking control system.

[0168] The embodiments of this specification provide a method and device for adaptive tracking control of a robot under a limited field of view constraint, wherein the method comprises: determining a motion model based on the robot kinematics, and determining an initial controller under the limited field of view constraint based on the motion model; determining unknown parameters of the initial controller based on least squares identification; determining a target controller based on the unknown parameters and the initial controller, and adaptively tracking the robot based on the target controller. By determining a motion model based on the robot kinematics, and determining an initial controller under the limited field of view constraint based on the motion model; determining unknown parameters of the initial controller based on least squares identification; determining a target controller based on the unknown parameters and the initial controller, and adaptively tracking the robot based on the target controller, the least squares parameter identification adopted can eliminate the influence of parameter uncertainty on the adaptive tracking control system after a finite number of parameter updates.

[0169] Corresponding to the above method embodiment, this specification also provides an embodiment of a robot adaptive tracking control device under a limited field of view constraint, Figure 8 FIG. 1 is a schematic diagram showing a structure of a robot adaptive tracking control device under a limited field of view constraint provided by an embodiment of the present specification. Figure 8 As shown, the device comprises:

[0170] A model determination module 801 is configured to determine a motion model based on robot kinematics, and determine an initial controller under field of view restriction constraints based on the motion model;

[0171] A parameter estimation module 802 is configured to determine unknown parameters of an initial controller based on least squares identification;

[0172] The tracking control module 803 is configured to determine a target controller based on unknown parameters and an initial controller, and perform adaptive tracking control on the robot based on the target controller.

[0173] In a possible implementation, the model determination module 801 is further configured to:

[0174] Determine the initial model based on the robot kinematics;

[0175] Determine the velocity relationship of the robot based on its geometry;

[0176] A motion model is determined based on the velocity relationship and the initial model.

[0177] In a possible implementation, the model determination module 801 is further configured to:

[0178] Determine the mission objective equation and safety constraint equation under the field of view restriction constraint;

[0179] Determine the control obstacle function and the control Lyapunov function based on the mission objective equation and the field of view constraint equation;

[0180] The initial controller is determined based on the control obstacle function and the control Lyapunov function.

[0181] In a possible implementation, the parameter estimation module 802 is further configured to:

[0182] Determine a deformation state equation based on the motion model, and integrate the deformation state equation in a first time period to determine a first integrated state equation;

[0183] Determining a second integrated state equation based on the integration of the integrated state equation during the second time period;

[0184] Determining an offline parameter update law based on the second integral state equation;

[0185] The unknown parameters are determined based on the offline parameter update law.

[0186] In a possible implementation, the tracking control module 803 is further configured to:

[0187] An update parameter is determined based on a preset rule, and a target controller is updated based on the update parameter to obtain an update controller, and adaptive tracking control is performed on the robot based on the update controller.

[0188] In a possible implementation, the tracking control module 803 is further configured to:

[0189] In the case of adaptive tracking control of the robot based on the target controller, when the unknown parameter exceeds the safety warning value, the unknown parameter is updated to determine the updated parameter.

[0190] In a possible implementation, the tracking control module 803 is further configured to:

[0191] Determine a preset update time, update the unknown parameters based on the preset update time, and determine the update parameters.

[0192] The embodiments of this specification provide a method and device for adaptive tracking control of a robot under a limited field of view constraint, wherein the device comprises: determining a motion model based on the robot kinematics, and determining an initial controller under the limited field of view constraint based on the motion model; determining unknown parameters of the initial controller based on least squares identification; determining a target controller based on the unknown parameters and the initial controller, and adaptively tracking the robot based on the target controller. By determining a motion model based on the robot kinematics, and determining an initial controller under the limited field of view constraint based on the motion model; determining unknown parameters of the initial controller based on least squares identification; determining a target controller based on the unknown parameters and the initial controller, and adaptively tracking the robot based on the target controller, the least squares parameter identification adopted can eliminate the influence of parameter uncertainty on the adaptive tracking control system after a finite number of parameter updates.

[0193] The above is a schematic scheme of a robot adaptive tracking control device under a limited field of view constraint of this embodiment. It should be noted that the technical scheme of the robot adaptive tracking control device under a limited field of view constraint and the technical scheme of the robot adaptive tracking control method under a limited field of view constraint belong to the same concept, and the details of the technical scheme of the robot adaptive tracking control device under a limited field of view constraint that are not described in detail can all be referred to the description of the technical scheme of the robot adaptive tracking control method under a limited field of view constraint.

[0194] Fig. 9 The structure block diagram of a computing device 900 provided according to an embodiment of the present specification is shown. The components of the computing device 900 include but are not limited to a memory 910 and a processor 920. The processor 920 is connected to the memory 910 via a bus 930, and a database 950 is used to store data.

[0195] The computing device 900 also includes an access device 940 that enables the computing device 900 to communicate via one or more networks 960. Examples of these networks include a public switched telephone network (PSTN), a local area network (LAN), a wide area network (WAN), a personal area network (PAN), or a combination of communication networks such as the Internet. The access device 940 may include one or more of any type of network interface (e.g., a network interface card (NIC)) that is wired or wireless, such as an IEEE 802.11 wireless local area network (WLAN) wireless interface, a world-wide interoperability for microwave access (Wi-MAX) interface, an Ethernet interface, a universal serial bus (USB) interface, a cellular network interface, a Bluetooth interface, and a near field communication (NFC).

[0196] In one embodiment of the present specification, the above components of the computing device 900 and Fig. 9 Other components not shown in the figure may also be connected to each other, for example, via a bus. It should be understood that Fig. 9 The computing device structure block diagram shown is only for the purpose of illustration, and is not intended to limit the scope of this specification. Those skilled in the art can add or replace other components as needed.

[0197] The computing device 900 may be any type of stationary or mobile computing device, including a mobile computer or mobile computing device (e.g., a tablet computer, a personal digital assistant, a laptop computer, a notebook computer, a netbook, etc.), a mobile phone (e.g., a smart phone), a wearable computing device (e.g., a smart watch, smart glasses, etc.), or other types of mobile devices, or a stationary computing device such as a desktop computer or a personal computer (PC). The computing device 900 may also be a mobile or stationary server.

[0198] Among them, the processor 920 is used to execute the following computer executable instructions, which, when executed by the processor, implement the steps of the above-mentioned robot adaptive tracking control method under the constraint of limited field of view. The above is a schematic scheme of a computing device of this embodiment. It should be noted that the technical scheme of the computing device and the technical scheme of the robot adaptive tracking control method under the constraint of limited field of view belong to the same concept. For the details not described in detail in the technical scheme of the computing device, please refer to the description of the technical scheme of the robot adaptive tracking control method under the constraint of limited field of view.

[0199] An embodiment of the present specification also provides a computer-readable storage medium storing computer-executable instructions, which, when executed by a processor, implement the steps of the above-mentioned robot adaptive tracking control method under the constraint of limited field of view.

[0200] The above is a schematic scheme of a computer-readable storage medium of this embodiment. It should be noted that the technical scheme of the storage medium and the technical scheme of the robot adaptive tracking control method under the above-mentioned field of view constraint belong to the same concept, and the details not described in detail in the technical scheme of the storage medium can be referred to the description of the technical scheme of the robot adaptive tracking control method under the above-mentioned field of view constraint.

[0201] An embodiment of the present specification also provides a computer program, wherein when the computer program is executed in a computer, the computer is caused to execute the steps of the above-mentioned robot adaptive tracking control method under the constraint of limited field of view.

[0202] The above is a schematic scheme of a computer program of this embodiment. It should be noted that the technical scheme of the computer program and the technical scheme of the robot adaptive tracking control method under the above-mentioned field of view constraint belong to the same concept, and the details not described in detail in the technical scheme of the computer program can be referred to the description of the technical scheme of the robot adaptive tracking control method under the above-mentioned field of view constraint.

[0203] The above is a description of a specific embodiment of the specification. Other embodiments are within the scope of the appended claims. In some cases, the actions or steps recorded in the claims can be performed in an order different from that in the embodiments and still achieve the desired results. In addition, the processes depicted in the drawings do not necessarily require the specific order or continuous order shown to achieve the desired results. In some embodiments, multitasking and parallel processing are also possible or may be advantageous.

[0204] The computer instructions include computer program codes, which may be in source code form, object code form, executable files or some intermediate forms, etc. The computer-readable medium may include: any entity or device capable of carrying the computer program code, recording medium, USB flash drive, mobile hard disk, magnetic disk, optical disk, computer memory, read-only memory (ROM), random access memory (RAM), electric carrier signal, telecommunication signal and software distribution medium, etc. It should be noted that the content contained in the computer-readable medium may be appropriately increased or decreased according to the requirements of legislation and patent practice in the jurisdiction. For example, in some jurisdictions, according to legislation and patent practice, computer-readable media do not include electric carrier signals and telecommunication signals.

[0205] It should be noted that, for the above-mentioned method embodiments, for the sake of simplicity of description, they are all expressed as a series of action combinations, but those skilled in the art should be aware that the embodiments of this specification are not limited by the order of the actions described, because according to the embodiments of this specification, some steps can be performed in other orders or simultaneously. Secondly, those skilled in the art should also be aware that the embodiments described in the specification are all preferred embodiments, and the actions and modules involved are not necessarily required by the embodiments of this specification.

[0206] In the above embodiments, the description of each embodiment has its own emphasis. For parts that are not described in detail in a certain embodiment, reference can be made to the relevant descriptions of other embodiments.

[0207] The preferred embodiments of this specification disclosed above are only used to help explain this specification. The optional embodiments do not describe all the details in detail, nor do they limit the invention to only the specific implementation methods described. Obviously, many modifications and changes can be made according to the content of the embodiments of this specification. This specification selects and specifically describes these embodiments in order to better explain the principles and practical applications of the embodiments of this specification, so that technicians in the relevant technical field can well understand and use this specification. This specification is only limited by the claims and their full scope and equivalents.

Claims

1. A robot adaptive tracking control method under field of view constraints, It is characterized in that include: Determine a motion model based on robot kinematics, and determine an initial controller under field of view constraints based on the motion model; Determining unknown parameters of the initial controller based on least squares identification; Determine a target controller based on the unknown parameters and the initial controller, and perform adaptive tracking control on the robot based on the target controller; The determining of the motion model based on robot kinematics comprises: determining an initial model based on the robot kinematics; Determining a velocity relationship of the robot based on a geometry of the robot; determining a motion model based on the velocity relationship and the initial model; The determining of an initial controller under a field of view restriction constraint based on the motion model comprises: Determine the mission objective equation and safety constraint equation under the field of view restriction constraint; Determine a control obstacle function and a control Lyapunov function based on the mission objective equation and the field of view constraint equation; determining an initial controller based on the control obstacle function and the control Lyapunov function; Wherein, the motion model includes: ; in, , , , is the coordinate of the robot in the global coordinate system, is the robot speed direction and The angle of the axis; Represent the angular velocities of the right and left wheels respectively; is an unknown parameter, ; Wherein, the initial controller comprises: ; in, , is a relaxation item; is a positive definite matrix, , and are two positive constants; ; ; ; ; in, is the relative distance between the robot and the target; the desired tracking distance is ; is the angle between the robot’s line of sight and the target; is the Lyapunov function; and yes exist and The projection below; and yes exist and The local motion coordinate system of the robot is .

2. The method according to claim 1, It is characterized in that The determining of unknown parameters of the initial controller based on least squares identification includes: Determine a deformation state equation based on the motion model, and determine a first integrated state equation based on integrating the deformation state equation in a first time period; Determining a second integrated state equation based on the integration of the integrated state equation in the second time period; Determining an offline parameter update law based on the second integral state equation; Unknown parameters are determined based on the offline parameter update law.

3. The method according to claim 1, It is characterized in that Also includes: An update parameter is determined based on a preset rule, and the target controller is updated based on the update parameter to obtain an update controller, and adaptive tracking control is performed on the robot based on the update controller.

4. The method according to claim 3, It is characterized in that The step of determining the update parameters based on a preset rule includes: In the case where the robot is adaptively tracked and controlled based on the target controller, when the unknown parameter exceeds the safety warning value, the unknown parameter is updated to determine the updated parameter.

5. The method according to claim 3, It is characterized in that The step of determining the update parameters based on a preset rule includes: A preset update time is determined, and the unknown parameters are updated based on the preset update time to determine the updated parameters.

6. A robot adaptive tracking control device under a limited field of view constraint, used to implement the steps of the robot adaptive tracking control method under a limited field of view constraint as claimed in any one of claims 1 to 5, It is characterized in that include: A model determination module is configured to determine a motion model based on robot kinematics, and determine an initial controller under field of view restriction constraints based on the motion model; a parameter estimation module, configured to determine unknown parameters of the initial controller based on least squares identification; The tracking control module is configured to determine a target controller based on the unknown parameters and the initial controller, and perform adaptive tracking control on the robot based on the target controller.

7. A computing device, It is characterized in that include: Memory and processor; The memory is used to store computer executable instructions, and the processor is used to execute the computer executable instructions. When the computer executable instructions are executed by the processor, the steps of the robot adaptive tracking control method under the field of view limitation constraint as described in any one of claims 1 to 5 are implemented.

8. A computer-readable storage medium storing computer-executable instructions, which, when executed by a processor, implement the steps of the robot adaptive tracking control method under field of view restriction constraints as described in any one of claims 1 to 5.