+

CN115542723A - Parameter setting method for ankle exoskeleton PD controller for man-machine in-loop debugging - Google Patents

Parameter setting method for ankle exoskeleton PD controller for man-machine in-loop debugging Download PDF

Info

Publication number
CN115542723A
CN115542723A CN202211222151.2A CN202211222151A CN115542723A CN 115542723 A CN115542723 A CN 115542723A CN 202211222151 A CN202211222151 A CN 202211222151A CN 115542723 A CN115542723 A CN 115542723A
Authority
CN
China
Prior art keywords
controller
exoskeleton
sample point
evaluation index
point
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202211222151.2A
Other languages
Chinese (zh)
Other versions
CN115542723B (en
Inventor
王念峰
孙泽时
黎子田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guangdong Flexwarm Advanced Materials & Technology Co ltd
South China University of Technology SCUT
Original Assignee
Guangdong Flexwarm Advanced Materials & Technology Co ltd
South China University of Technology SCUT
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Guangdong Flexwarm Advanced Materials & Technology Co ltd, South China University of Technology SCUT filed Critical Guangdong Flexwarm Advanced Materials & Technology Co ltd
Priority to CN202211222151.2A priority Critical patent/CN115542723B/en
Publication of CN115542723A publication Critical patent/CN115542723A/en
Application granted granted Critical
Publication of CN115542723B publication Critical patent/CN115542723B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B11/00Automatic controllers
    • G05B11/01Automatic controllers electric
    • G05B11/36Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
    • G05B11/42Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明公开了一种人机在环调试的踝关节外骨骼PD控制器参数整定方法,可用于在不同的穿戴者和行走工况的条件下整定踝关节外骨骼的PD控制器参数使控制效果达到最优,整定过程通过人机在环的在线调节,无须特定测试环境或设备的介入。该方法过程如下:通过穿戴者在步行工况的踝关节外骨骼实际运行过程中采集PD控制器的比例系数Kp和微分系数Kd参数组合,以及对应的辅助力控制误差,导入高斯回归算法中进行曲面拟合,得到曲面的最低点(即预测的控制误差最小)的Kp和Kd参数,再反导入到外骨骼PD控制器中更新参数,重复人机在环的参数迭代过程,最终Kp和Kd参数收敛时即代表PD控制器参数整定至针对当前穿戴者及步行工况的最优。

Figure 202211222151

The invention discloses a man-machine-in-the-loop debugging ankle exoskeleton PD controller parameter setting method, which can be used to adjust the PD controller parameters of the ankle exoskeleton under different conditions of wearers and walking conditions so that the control effect can be improved. To achieve the optimum, the setting process is adjusted online through human-machine-in-the-loop, without the intervention of specific test environments or equipment. The process of the method is as follows: the wearer collects the combination of the proportional coefficient K p and the differential coefficient K d of the PD controller during the actual operation of the ankle exoskeleton in the walking condition, and the corresponding auxiliary force control error, and then imports the Gaussian regression algorithm Surface fitting is carried out in , and the K p and K d parameters of the lowest point of the surface (that is, the predicted control error is the smallest) are obtained, and then imported into the exoskeleton PD controller to update the parameters, and repeat the parameter iteration process of man-machine in the loop, When the final K p and K d parameters converge, it means that the PD controller parameters are adjusted to the optimum for the current wearer and walking conditions.

Figure 202211222151

Description

一种人机在环调试的踝关节外骨骼PD控制器参数整定方法A human-machine-in-the-loop debugging method for parameter tuning of ankle exoskeleton PD controller

技术领域technical field

本发明涉及外骨骼控制技术领域,具体涉及一种人机在环调试的踝关节外骨骼PD控制器参数整定方法。The invention relates to the technical field of exoskeleton control, in particular to a method for parameter setting of an ankle exoskeleton PD controller for man-machine-in-the-loop debugging.

背景技术Background technique

外骨骼系统是一种典型的人机系统,其工作过程是人体与机器人相互合作,以人体的各种主观意图为规划核心,结合传感器技术的感知和机器人的力量优势来落实和拓展。踝关节外骨骼通过外骨骼驱动系统向踝关节施加一个辅助力矩,在步行运动中部分替代人体踝关节本身的发力,以此起到减少人体代谢消耗的效果。由于踝关节的步行运动具有特定的生物力学性质,外骨骼施加的辅助力矩须要具备合适的样式以贴合它,才能实现替代踝关节发力的效果,因此,踝关节外骨骼要有合适的控制器,依照合适的辅助力矩样式来控制外骨骼的驱动力,实现当前步态周期相位所需的目标辅助力矩大小。The exoskeleton system is a typical human-machine system. Its working process is the mutual cooperation between the human body and the robot. It takes various subjective intentions of the human body as the planning core, and combines the perception of sensor technology and the strength advantages of robots to implement and expand. The ankle joint exoskeleton applies an auxiliary torque to the ankle joint through the exoskeleton drive system, which partially replaces the force of the human ankle joint itself during walking, thereby reducing the metabolic consumption of the human body. Because the walking motion of the ankle joint has specific biomechanical properties, the auxiliary torque applied by the exoskeleton must have a suitable style to fit it, so as to achieve the effect of replacing the force of the ankle joint. Therefore, the ankle joint exoskeleton must have appropriate control The device controls the driving force of the exoskeleton according to the appropriate auxiliary torque pattern to achieve the target auxiliary torque required for the current gait cycle phase.

当前踝关节外骨骼的控制常采用基于力反馈的PD控制器,其性质由比例系数Kp及微分系数Kd决定,然而不同的穿戴者和不同的步行工况都会影响外骨骼与人体组成的系统,导致达到最优控制效果时的PD控制器的Kp和Kd参数往往有所不同。为此,有必要根据不同工况来对外骨骼PD控制器的参数进行整定以使其控制效果最优,而外骨骼具有特殊性,不像一般设备可以孤立地在测试台架上进行控制器参数整定,而必须与目标穿戴者组合并在目标步行工况中才能表征出PD控制器所控制的系统。目前,亟待提出一种人机在环的外骨骼PD控制器参数整定方法。At present, the control of ankle exoskeleton usually adopts PD controller based on force feedback, and its properties are determined by the proportional coefficient K p and differential coefficient K d . However, different wearers and different walking conditions will affect the relationship between the exoskeleton and the human body. system, the K p and K d parameters of the PD controller are often different when the optimal control effect is achieved. For this reason, it is necessary to adjust the parameters of the exoskeleton PD controller according to different working conditions to optimize the control effect, and the exoskeleton has special features, unlike ordinary equipment, which can be isolated on the test bench for controller parameters setting, the system controlled by the PD controller must be characterized in combination with the target wearer and in the target walking condition. At present, it is urgent to propose a human-machine-in-the-loop exoskeleton PD controller parameter tuning method.

发明内容Contents of the invention

本发明的目的是为了解决现有技术中的上述缺陷,提供一种人机在环调试的踝关节外骨骼PD控制器参数整定方法。该方法通过在穿戴者在步行工况的踝关节外骨骼实际运行过程中采集PD控制器的比例系数Kp和微分系数Kd参数组合,以及对应的辅助力控制误差,导入高斯回归算法中进行曲面拟合,得到曲面的最低点(即预测的控制误差最小)的Kp和Kd参数,再反导入到外骨骼PD控制器中更新参数,重复人机在环的参数迭代过程,最终Kp和Kd参数收敛时即代表PD控制器参数整定至针对当前穿戴者及步行工况的最优。The object of the present invention is to solve the above-mentioned defects in the prior art, and provide a method for parameter setting of an ankle joint exoskeleton PD controller for man-machine-in-the-loop debugging. This method collects the parameter combination of the proportional coefficient K p and the differential coefficient K d of the PD controller during the actual operation of the ankle exoskeleton in the walking condition, and the corresponding auxiliary force control error, and imports it into the Gaussian regression algorithm. Surface fitting, get the K p and K d parameters of the lowest point of the surface (that is, the predicted control error is the smallest), and then import them into the exoskeleton PD controller to update the parameters, repeat the parameter iteration process of man-machine in the loop, and finally K When the p and K d parameters converge, it means that the PD controller parameters are adjusted to the optimum for the current wearer and walking conditions.

本发明的目的可以通过采取如下技术方案达到:The purpose of the present invention can be achieved by taking the following technical solutions:

一种人机在环调试的踝关节外骨骼PD控制器参数整定方法,所述参数整定方法包括如下步骤:A method for parameter tuning of an ankle joint exoskeleton PD controller for man-machine in-loop debugging, the parameter tuning method comprising the steps of:

步骤S1、选取初始PD控制器参数,通过记录外骨骼在当前PD控制器参数下的辅助力控制误差,建立外骨骼PD控制器参数整定的初始样本集,此步骤为步骤S2的高斯回归过程提供了初始样本集用于训练;Step S1, select the initial PD controller parameters, and establish the initial sample set of exoskeleton PD controller parameter tuning by recording the assist force control error of the exoskeleton under the current PD controller parameters. This step provides the Gaussian regression process of step S2. The initial sample set is used for training;

步骤S2、将初始样本集在内的现有样本集作为训练数据,导入高斯回归算法中进行训练,重复求解最优样本点直至满足收敛条件,其中最优样本点为使每个步态周期PD控制器误差最小的点,满足收敛条件后,确定最优比例系数Kp和微分系数Kd取值作为踝关节外骨骼PD控制器的参数整定结果。Step S2, use the existing sample set including the initial sample set as training data, import it into the Gaussian regression algorithm for training, and repeatedly solve the optimal sample point until the convergence condition is satisfied, wherein the optimal sample point is to make each gait cycle PD The point at which the controller error is the smallest meets the convergence conditions, and the optimal proportional coefficient K p and differential coefficient K d are determined as the parameter tuning results of the ankle exoskeleton PD controller.

进一步地,所述步骤S1过程如下:Further, the process of step S1 is as follows:

S11、规定PD控制器的比例系数Kp和微分系数Kd的初始定义域分别为[0,p0]及[0,d0],在[0,p0]及[0,d0]中分别以a0和b0的步长采样,作为初始样本集,得到初始样本点点阵{X=[Kp,Kd],Kp∈{0,a0,2a0,…,p0},Kd∈{0,b0,2b0,…,d0}},所述初始样本点点阵在步骤S2中作为高斯回归算法的训练集的自变量,为得到所述训练集的因变量,在初始样本点点阵中做机械抽样,确定N个均匀分布的初始样本点Xn,n=1,2,…,N;S11. It is stipulated that the initial definition domains of the proportional coefficient K p and the differential coefficient K d of the PD controller are [0,p 0 ] and [0,d 0 ] respectively, and in [0,p 0 ] and [0,d 0 ] Sampling at the step size of a 0 and b 0 respectively, as the initial sample set, to obtain the initial sample point matrix {X=[K p ,K d ],K p ∈{0,a 0 ,2a 0 ,…,p 0 },K d ∈{0,b 0 ,2b 0 ,…,d 0 }}, the initial sample point matrix is used as the independent variable of the training set of the Gaussian regression algorithm in step S2, and is the factor for obtaining the training set variable, perform mechanical sampling in the initial sample point lattice, and determine N uniformly distributed initial sample points X n , n=1,2,...,N;

S12、在上述机械抽样的N个初始样本点中取一个未选取过的初始样本点,设置为当前踝关节外骨骼PD控制器的参数,规定穿戴者在当前工况中进行步行运动,完成完整的M个步态周期,并记录过程中的控制误差em,m=1,2,…,M;S12. Take an unselected initial sample point from the N initial sample points in the above-mentioned mechanical sampling, and set it as the parameter of the PD controller of the current ankle joint exoskeleton, and stipulate that the wearer can walk in the current working condition to complete the complete M gait cycles of , and record the control error e m during the process, m=1,2,...,M;

S13、对已记录的控制误差在每个步态周期内作均匀的样条插值,得到M个具有100个元素的控制误差序列{em,i,m=1,2,…,M|i=1,2,…,100},其中em,i表示控制误差第m个步态周期的第i个元素;S13. Perform uniform spline interpolation on the recorded control error in each gait cycle to obtain M control error sequences {e m,i ,m=1,2,...,M|i with 100 elements =1,2,...,100}, where e m,i represent the i-th element of the m-th gait cycle of the control error;

S14、为了准确评估使用不同PD控制器参数的外骨骼控制误差,对每个步态周期的控制误差序列计算评估指数Em,Em表示第m个步态周期的评估指数,计算方式如下:S14. In order to accurately evaluate the exoskeleton control error using different PD controller parameters, the evaluation index E m is calculated for the control error sequence of each gait cycle, and E m represents the evaluation index of the m-th gait cycle, and the calculation method is as follows:

Figure BDA0003877851390000031
Figure BDA0003877851390000031

其中Fi为控制误差发生时对应的目标踝关节辅助力矩大小,计算得到M个评估指数Em,m=1,2,…,M,然后对M个评估指数求平均得到平均评估指数

Figure BDA0003877851390000032
Among them, F i is the corresponding target ankle auxiliary moment when the control error occurs, and M evaluation indices E m are calculated, m=1, 2,...,M, and then the average evaluation index is obtained by averaging the M evaluation indices
Figure BDA0003877851390000032

S15、重复步骤S12至步骤S14,直至N个初始样本点均被选取,最终得到初始样本点Xn对应的平均评估指数

Figure BDA0003877851390000033
其中
Figure BDA0003877851390000034
表示第n个初始样本点的平均评估指数
Figure BDA0003877851390000035
平均评估指数在步骤S2中作为高斯回归算法的训练集的因变量。S15. Repeat steps S12 to S14 until N initial sample points are selected, and finally obtain the average evaluation index corresponding to the initial sample point X n
Figure BDA0003877851390000033
in
Figure BDA0003877851390000034
Indicates the average evaluation index of the nth initial sample point
Figure BDA0003877851390000035
The average evaluation index is used as the dependent variable of the training set of the Gaussian regression algorithm in step S2.

进一步地,所述步骤S2过程如下:Further, the process of step S2 is as follows:

S21、将包括初始样本点在内的现有全部样本点导入高斯回归算法进行训练,其中将当前PD控制器的参数Xn=[Kp,Kd]作为自变量,将平均评估指数

Figure BDA0003877851390000036
作为因变量,并基于最大似然法,使用牛顿法或共轭梯度法等非线性数值优化算法来寻优高斯回归算法的超参数,使之最匹配现有样本集的真值分布和噪声分布,然后回归得到拟合曲面,拟合曲面上每一点包含自变量和因变量信息,所述自变量为PD控制器的参数,所述因变量为该自变量对应的预测平均评估指数;S21. Import all existing sample points including the initial sample points into the Gaussian regression algorithm for training, wherein the parameter X n = [K p , K d ] of the current PD controller is used as an independent variable, and the average evaluation index
Figure BDA0003877851390000036
As a dependent variable, and based on the maximum likelihood method, use nonlinear numerical optimization algorithms such as Newton method or conjugate gradient method to optimize the hyperparameters of the Gaussian regression algorithm so that it best matches the true value distribution and noise distribution of the existing sample set , and then regress to obtain a fitting surface, each point on the fitting surface contains independent variable and dependent variable information, the independent variable is a parameter of the PD controller, and the dependent variable is the predicted average evaluation index corresponding to the independent variable;

S22、在经训练好的高斯回归算法得到的拟合曲面上逐一检索点阵上每一点的预测因变量,得到预测因变量最小值所处的当前最优样本点xopt=[Kpopt,Kdopt],其中Kpopt和Kdopt分别为PD控制器的比例系数Kp和微分系数Kd的当前最优参数取值,当前最优样本点为局部最优样本点,并非全局最优样本点,还需通过步骤S23到S25进行收敛性判别;S22. Retrieve the predicted dependent variable of each point on the lattice one by one on the fitted surface obtained by the trained Gaussian regression algorithm, and obtain the current optimal sample point where the minimum value of the predicted dependent variable is x opt = [K popt , K dopt ], where K popt and K dopt are the current optimal parameter values of the proportional coefficient K p and differential coefficient K d of the PD controller respectively, and the current optimal sample point is the local optimal sample point, not the global optimal sample point , it is also necessary to perform convergence discrimination through steps S23 to S25;

S23、将该当前最优参数取值Kpopt和Kdopt作为新的比例系数Kp和微分系数Kd设置为当前踝关节外骨骼PD控制器的参数,规定穿戴者在当前工况中进行步行运动,完成完整的M个步态周期,并记录过程中的控制误差em,m=1,2,…,M;S23. Set the current optimal parameter values K popt and K dopt as the new proportional coefficient K p and differential coefficient K d as the parameters of the current ankle exoskeleton PD controller, and stipulate that the wearer can walk in the current working condition Movement, complete M complete gait cycles, and record the control error em during the process, m =1,2,...,M;

S24、重复步骤S13到S14,得到的平均评估指数

Figure BDA0003877851390000041
为当前最优样本点xopt的平均评估指数;S24. Repeat steps S13 to S14 to obtain the average evaluation index
Figure BDA0003877851390000041
is the average evaluation index of the current optimal sample point x opt ;

S25、将当前最优样本点xopt=[kpopt,kdopt]记录为新的样本点,与初始样本点共同组成为现有样本集,若现有样本集中已有的任意一样本点与新的样本点的欧式距离小于一定阈值,则满足高斯回归过程的收敛性判别,选择该点和新的样本点两者之间平均评估指数

Figure BDA0003877851390000042
最小者为最优,即平均评估指数
Figure BDA0003877851390000043
最小的点为全局最优样本点,所述全局最优样本点的比例系数Kp和微分系数Kd取值作为踝关节外骨骼PD控制器的参数整定结果。S25. Record the current optimal sample point x opt = [k popt , k dot ] as a new sample point, and form an existing sample set together with the initial sample point. If any sample point in the existing sample set is the same as If the Euclidean distance of the new sample point is less than a certain threshold, it meets the convergence judgment of the Gaussian regression process, and the average evaluation index between the point and the new sample point is selected
Figure BDA0003877851390000042
The smallest is the best, that is, the average evaluation index
Figure BDA0003877851390000043
The smallest point is the global optimal sample point, and the values of the proportional coefficient K p and the differential coefficient K d of the global optimal sample point are used as the parameter tuning results of the ankle exoskeleton PD controller.

进一步地,所述步骤S25中还包括:Further, the step S25 also includes:

步骤S25.1、若新的样本点不处于定义域的边界上,且与样本集中任意某一点的欧氏距离小于一定阈值,说明已达到收敛,选择该任意某一点和新的样本点两者之间平均评估指数

Figure BDA0003877851390000044
最小者为最优,平均评估指数
Figure BDA0003877851390000045
最小者的比例系数Kp和微分系数Kd取值作为踝关节外骨骼PD控制器的参数整定结果;Step S25.1. If the new sample point is not on the boundary of the definition domain, and the Euclidean distance to any point in the sample set is less than a certain threshold, it means that convergence has been achieved, and the arbitrary point and the new sample point are selected. average evaluation index
Figure BDA0003877851390000044
The smallest is the best, the average evaluation index
Figure BDA0003877851390000045
The value of the smallest proportional coefficient K p and differential coefficient K d is used as the parameter tuning result of the ankle exoskeleton PD controller;

步骤S25.2、若新的样本点不处于定义域的边界上,且与样本集中任意一点的欧氏距离均不小于一定阈值,则从步骤S21开始再按顺序执行流程步骤;Step S25.2. If the new sample point is not on the boundary of the defined domain, and the Euclidean distance from any point in the sample set is not less than a certain threshold, then start from step S21 and then execute the process steps in order;

步骤S25.3、若新的样本点处于比例系数Kp和微分系数Kd的定义域边界上,为了更加准确的找到全局最优样本点,将定义域向该边界外扩展一定距离Δl形成新的定义域[0,p]及[0,d]后,从步骤S21开始再按顺序执行流程步骤。Step S25.3. If the new sample point is on the domain boundary of the proportional coefficient K p and the differential coefficient K d , in order to find the global optimal sample point more accurately, extend the domain of definition to the outside of the boundary by a certain distance Δl to form a new After the domains [0,p] and [0,d] are defined, the process steps are executed sequentially from step S21.

本发明相对于现有技术具有如下的优点及效果:Compared with the prior art, the present invention has the following advantages and effects:

(1)本发明充分考虑了外骨骼在不同工况下最优PD控制器参数不同的问题,有效地降低了外骨骼在不同工况下实际运行的辅助力控制误差,最大化外骨骼的辅助效果。(1) The present invention fully considers the problem that the optimal PD controller parameters of the exoskeleton are different under different working conditions, effectively reduces the auxiliary force control error of the actual operation of the exoskeleton under different working conditions, and maximizes the auxiliary power of the exoskeleton Effect.

(2)本发明将人的实际运动信息融合并不断更新在外骨骼的控制过程中,整个调试过程是人机在环的在线调节,反复利用高斯过程的无模型预测能力,从一个接一个的输入和输出组合出发,逐步逼近目标的最优值。(2) The present invention fuses and continuously updates the actual human motion information in the control process of the exoskeleton. The whole debugging process is an online adjustment of man-machine in the loop, and repeatedly utilizes the model-free prediction ability of the Gaussian process, from one input to the next Starting from the combination with the output, it gradually approaches the optimal value of the target.

(3)本发明可用于在不同的穿戴者和行走工况的条件下整定踝关节外骨骼的PD控制器参数使控制效果达到最优,且过程仅依靠外骨骼及其上位机(PC端、移动端、MCU等)的计算,无须特定测试环境或设备的介入。(3) The present invention can be used to adjust the parameters of the PD controller of the ankle joint exoskeleton under different conditions of wearers and walking conditions to optimize the control effect, and the process only depends on the exoskeleton and its host computer (PC terminal, mobile terminal, MCU, etc.) without the intervention of a specific test environment or equipment.

附图说明Description of drawings

此处所说明的附图用来提供对本发明的进一步理解,构成本申请的一部分,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:The accompanying drawings described here are used to provide a further understanding of the present invention and constitute a part of the application. The schematic embodiments of the present invention and their descriptions are used to explain the present invention and do not constitute improper limitations to the present invention. In the attached picture:

图1是本发明中人机在环的踝关节外骨骼PD控制器参数整定方法示意图。Fig. 1 is a schematic diagram of a parameter setting method of an ankle exoskeleton PD controller in the present invention.

具体实施方式detailed description

为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。In order to make the purpose, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments It is a part of embodiments of the present invention, but not all embodiments. Based on the embodiments of the present invention, all other embodiments obtained by persons of ordinary skill in the art without making creative efforts belong to the protection scope of the present invention.

实施例1Example 1

在本实施例中,场景为健康人以平均1.25m/s的步速穿戴踝关节外骨骼自由行走,下面具体介绍使用本发明在该行走过程中对踝关节外骨骼进行PD控制器的参数整定过程。In this embodiment, the scene is that a healthy person walks freely wearing an ankle exoskeleton at an average pace of 1.25m/s. The following describes in detail how to use the present invention to adjust the parameters of the PD controller for the ankle exoskeleton during the walking process. process.

如附图1所示,本实施例公开的人机在环的踝关节外骨骼PD控制器参数整定方法包括下列步骤:As shown in accompanying drawing 1, the man-machine-in-the-loop ankle exoskeleton PD controller parameter tuning method disclosed in this embodiment includes the following steps:

步骤S1、选取初始PD控制器参数,通过记录外骨骼在当前PD控制器参数下的辅助力控制误差,建立外骨骼PD控制器参数整定的初始样本集,过程如下:Step S1. Select the initial PD controller parameters, and establish an initial sample set for parameter tuning of the exoskeleton PD controller by recording the assist force control error of the exoskeleton under the current PD controller parameters. The process is as follows:

步骤S11、规定PD控制器的比例系数Kp和微分系数Kd的初始定义域分别为[0,6]及[0,12],将Kp和Kd的定义域分别以0.1和0.2的步长作机械抽样,得到待搜索的点阵{X=[Kp,Kd],Kp∈{0,0.1,0.2,…,6},Kd∈{0,0.2,0.4,…,12}}在其中作机械抽样,确定9个均匀分布的初始样本点X1=[1,3]、X2=[1,6]、X3=[1,9]、X4=[3,3]、X5=[3,6]、X6=[3,9]、X7=[5,3]、X8=[5,6]、X9=[5,9];Step S11, stipulate that the initial definition domains of the proportional coefficient K p and the differential coefficient K d of the PD controller are [0,6] and [0,12] respectively, and the definition domains of K p and K d are respectively set to 0.1 and 0.2 Step length is used for mechanical sampling to obtain the lattice to be searched {X=[K p ,K d ], K p ∈{0,0.1,0.2,…,6},K d ∈{0,0.2,0.4,…, 12}} Do mechanical sampling in it, determine 9 uniformly distributed initial sample points X 1 =[1,3], X 2 =[1,6], X 3 =[1,9], X 4 =[3 ,3], X 5 =[3,6], X 6 =[3,9], X 7 =[5,3], X 8 =[5,6], X 9 =[5,9];

步骤S12、在上述机械抽样的9个初始样本点中取一个未选取过的初始样本点,设置为当前踝关节外骨骼PD控制器的参数,规定穿戴者在当前工况中进行步行运动,完成完整的12个步态周期,并记录过程中的控制误差em,m=1,2,…,12;Step S12: Take an unselected initial sample point from the 9 initial sample points in the above-mentioned mechanical sampling, set it as the parameter of the PD controller of the current ankle joint exoskeleton, stipulate that the wearer should perform walking exercise in the current working condition, and complete Complete 12 gait cycles, and record the control error e m during the process, m=1,2,...,12;

步骤S13、对已记录的控制误差在每个步态周期内作均匀的样条插值,得到12个具有100个元素的控制误差序列{em,i,m=1,2,…,12|i=1,2,…,100};Step S13: Perform uniform spline interpolation on the recorded control errors in each gait cycle to obtain 12 control error sequences with 100 elements {e m,i ,m=1,2,...,12| i=1,2,...,100};

步骤S14、对每个步态周期的控制误差序列计算一个评估指数Em,Em表示第m个步态周期的评估指数,其计算方式如下Step S14, calculate an evaluation index E m for the control error sequence of each gait cycle, E m represents the evaluation index of the mth gait cycle, and the calculation method is as follows

Figure BDA0003877851390000071
Figure BDA0003877851390000071

其中em,i表示控制误差第m个步态周期的第i个元素,Fi为控制误差发生时对应的目标踝关节辅助力矩大小,得到12个评估指数Em,m=1,2,…,12,对12个评估指数求平均得到平均评估指数

Figure BDA0003877851390000072
Among them, e m, i represent the i-th element of the m-th gait cycle of the control error, F i is the corresponding target ankle auxiliary torque when the control error occurs, and 12 evaluation indices E m ,m=1,2, ...,12, average the 12 evaluation indexes to obtain the average evaluation index
Figure BDA0003877851390000072

步骤S15、重复步骤S12至步骤S14,直至9个初始样本点均被选取,最终得到初始样本点Xn对应的平均评估指数

Figure BDA0003877851390000073
其中
Figure BDA0003877851390000074
表示第n个初始样本点的平均评估指数
Figure BDA0003877851390000075
Step S15, repeat step S12 to step S14 until all 9 initial sample points are selected, and finally obtain the average evaluation index corresponding to the initial sample point X n
Figure BDA0003877851390000073
in
Figure BDA0003877851390000074
Indicates the average evaluation index of the nth initial sample point
Figure BDA0003877851390000075

在本实施例中,步骤S1建立的外骨骼PD控制器参数整定的初始样本集如表1所示。In this embodiment, the initial sample set of exoskeleton PD controller parameter tuning established in step S1 is shown in Table 1.

表1.实施例1的参数整定初始样本集表Table 1. Parameter tuning initial sample set table of embodiment 1

初始样本次序initial sample order K<sub>p</sub>K<sub>p</sub> K<sub>d</sub>K<sub>d</sub> EE. 11 11 33 44.71444.714 22 11 66 38.50738.507 33 11 99 34.88834.888 44 33 33 20.24720.247 55 33 66 21.04721.047 66 33 99 21.90621.906 77 55 33 16.28616.286 88 55 66 18.29318.293 99 55 99 20.20420.204

步骤S2、将初始样本集在内的现有样本集作为训练数据,导入高斯回归算法中进行训练,重复求解最优样本点直至满足收敛条件,确定最优比例系数Kp和微分系数Kd取值作为踝关节外骨骼PD控制器的参数整定结果,过程如下:Step S2, use the existing sample set including the initial sample set as training data, import it into the Gaussian regression algorithm for training, repeatedly solve the optimal sample point until the convergence condition is met, and determine the optimal proportional coefficient K p and differential coefficient K d The value is used as the parameter tuning result of the ankle exoskeleton PD controller, and the process is as follows:

步骤S21、将包括初始样本点在内的现有全部样本点导入高斯回归算法进行训练,其中将当前PD控制器的参数Xn=[Kp,Kd]作为自变量,将平均评估指数

Figure BDA0003877851390000084
作为因变量,并基于最大似然法,使用牛顿法或共轭梯度法等非线性数值优化算法来寻优高斯回归算法的超参数,使之最匹配现有样本集的真值分布和噪声分布,然后回归得到自变量与因变量的拟合曲面;Step S21. Import all existing sample points including the initial sample points into the Gaussian regression algorithm for training, wherein the current PD controller parameter X n = [K p , K d ] is used as an independent variable, and the average evaluation index
Figure BDA0003877851390000084
As a dependent variable, and based on the maximum likelihood method, use nonlinear numerical optimization algorithms such as Newton method or conjugate gradient method to optimize the hyperparameters of the Gaussian regression algorithm so that it best matches the true value distribution and noise distribution of the existing sample set , and then regression to obtain the fitting surface of the independent variable and the dependent variable;

步骤S22、在经训练好的高斯回归算法得到的拟合曲面上逐一检索点阵上每一点的预测因变量,得到预测因变量最小值所处的当前最优样本点xopt=[Kpopt,Kdopt],其中Kdopt和Kdopt分别为PD控制器的比例系数Kp和微分系数Kd的当前最优参数取值;Step S22. Retrieve the predicted dependent variable of each point on the lattice one by one on the fitted surface obtained by the trained Gaussian regression algorithm, and obtain the current optimal sample point x opt where the minimum value of the predicted dependent variable is located x opt = [K popt , K dopt ], where K dopt and K dopt are the current optimal parameter values of the proportional coefficient K p and the differential coefficient K d of the PD controller respectively;

步骤S23、将该当前最优参数取值Kpopt和Kdopt作为新的比例系数Kp和微分系数Kd设置为当前踝关节外骨骼PD控制器的参数,规定穿戴者在当前工况中进行步行运动,完成完整的M个步态周期,并记录过程中的控制误差em,m=1,2,…,M;Step S23, the current optimal parameter values K popt and K dopt are used as the new proportional coefficient K p and differential coefficient K d as the parameters of the current ankle exoskeleton PD controller, and the wearer is required to perform in the current working condition Walking movement, complete M complete gait cycles, and record the control error em during the process, m =1,2,...,M;

步骤S24、重复步骤S13到S14,得到的平均评估指数

Figure BDA0003877851390000081
为当前最优样本点xopt的平均评估指数;Step S24, repeating steps S13 to S14, the obtained average evaluation index
Figure BDA0003877851390000081
is the average evaluation index of the current optimal sample point x opt ;

S25、将当前最优样本点xopt=[kpopt,kdopt]记录为新的样本点,与初始样本点共同组成为现有样本集,若现有样本集中已有的任意一样本点与新的样本点的欧式距离小于一定阈值,则选择该点和新的样本点两者之间平均评估指数

Figure BDA0003877851390000082
最小者为最优,平均评估指数
Figure BDA0003877851390000083
最小者的比例系数Kp和微分系数Kd取值作为踝关节外骨骼PD控制器的参数整定结果。S25. Record the current optimal sample point x opt = [k popt , k dot ] as a new sample point, and form an existing sample set together with the initial sample point. If any sample point in the existing sample set is the same as If the Euclidean distance of the new sample point is less than a certain threshold, then select the average evaluation index between the point and the new sample point
Figure BDA0003877851390000082
The smallest is the best, the average evaluation index
Figure BDA0003877851390000083
The value of the smallest proportional coefficient K p and differential coefficient K d is used as the parameter tuning result of the ankle exoskeleton PD controller.

在本实施例中,步骤S25还包括:In this embodiment, step S25 also includes:

步骤S25.1、若新的样本点不处于定义域的边界上,且与样本集中任意某一点的欧氏距离小于1,说明已达到收敛,选择该任意某一点和新的样本点两者之间平均评估指数

Figure BDA0003877851390000091
最小者为最优,平均评估指数
Figure BDA0003877851390000092
最小者的比例系数Kp和微分系数Kd取值作为踝关节外骨骼PD控制器的参数整定结果;Step S25.1. If the new sample point is not on the boundary of the domain of definition, and the Euclidean distance to any point in the sample set is less than 1, it means that convergence has been achieved. Select the point between the arbitrary point and the new sample point Inter-average evaluation index
Figure BDA0003877851390000091
The smallest is the best, the average evaluation index
Figure BDA0003877851390000092
The value of the smallest proportional coefficient K p and differential coefficient K d is used as the parameter tuning result of the ankle exoskeleton PD controller;

步骤S25.2、若新的样本点不处于定义域的边界上,且与样本集中任意一点的欧氏距离均不小于1,则从步骤S21开始再按顺序执行流程步骤;Step S25.2. If the new sample point is not on the boundary of the definition domain, and the Euclidean distance from any point in the sample set is not less than 1, then start from step S21 and then execute the process steps in order;

步骤S25.3、若新的样本点处于比例系数Kp和微分系数Kd的定义域边界上,则将定义域向该边界外扩展一定距离,若在Kp边界上则扩展1,若在Kd边界上则扩展2,形成新的定义域[0,p]及[0,d]后,从步骤S21开始再按顺序执行流程步骤。Step S25.3. If the new sample point is on the domain boundary of the proportional coefficient K p and the differential coefficient K d , expand the domain to a certain distance outside the boundary, if it is on the boundary of K p , extend it by 1, if it is on the boundary of K p On the K d boundary, 2 is extended to form new domains [0, p] and [0, d], and then the process steps are executed sequentially from step S21.

在本实施例中,步骤S2过程中得到的过程样本集如表2所示,In this embodiment, the process sample set obtained in the step S2 process is shown in Table 2,

表2.实施例1的参数整定过程样本集Table 2. The parameter tuning process sample set of embodiment 1

过程样本次序Process Sample Order K<sub>p</sub>K<sub>p</sub> K<sub>d</sub>K<sub>d</sub> EE. 11 4.94.9 00 23.75023.750 22 4.94.9 1212 19.32919.329 33 <u>4.5</u><u>4.5</u> <u>3.8</u><u>3.8</u> <u>14.281</u><u>14.281</u> 44 4.44.4 3.63.6 17.70617.706

过程样本次序4的样本点与过程样本次序3的样本点之间的欧式距离小于1,则说明已收敛,且比较过程样本次序3和过程样本次序4的平均评估指数

Figure BDA0003877851390000093
最后选取过程样本次序3的样本点为最优点,该点比例系数Kp和微分系数Kd取值作为踝关节外骨骼PD控制器的参数整定结果If the Euclidean distance between the sample point of process sample order 4 and the sample point of process sample order 3 is less than 1, it means that it has converged, and compare the average evaluation index of process sample order 3 and process sample order 4
Figure BDA0003877851390000093
Finally, the sample point of process sample order 3 is selected as the optimal point, and the value of the proportional coefficient K p and differential coefficient K d of this point is used as the parameter tuning result of the ankle exoskeleton PD controller

实施例2Example 2

在本实施例中,采用与实施例1相同的实验场景,下面具体介绍本实施例中对踝关节外骨骼进行PD控制器的参数整定过程。In this embodiment, the same experimental scene as in Embodiment 1 is adopted, and the parameter tuning process of the PD controller for the ankle exoskeleton in this embodiment will be introduced in detail below.

步骤S1、选取初始PD控制器参数,通过记录外骨骼在当前PD控制器参数下的辅助力控制误差,建立外骨骼PD控制器参数整定的初始样本集,过程如下:Step S1. Select the initial PD controller parameters, and establish an initial sample set for parameter tuning of the exoskeleton PD controller by recording the assist force control error of the exoskeleton under the current PD controller parameters. The process is as follows:

步骤S11、规定PD控制器的比例系数Kp和微分系数Kd的初始定义域都为[0,6],将Kp和Kd的定义域都以0.1的步长作机械抽样,得到待搜索的点阵{X=[Kp,Kd],Kp∈{0,0.1,0.2,…,6},Kd∈{0,0.1,0.2,…,6}}在其中作机械抽样,确定6个均匀分布的初始样本点X1=[1,3]、X2=[1,6]、X3=[3,3]、X4=[3,6]、X5=[5,3]、X6=[5,6];Step S11, stipulate that the initial domains of the proportional coefficient K p and the differential coefficient K d of the PD controller are both [0,6], perform mechanical sampling on the domains of K p and K d with a step size of 0.1, and obtain The searched lattice {X=[K p ,K d ], K p ∈{0,0.1,0.2,…,6},K d ∈{0,0.1,0.2,…,6}} is mechanically sampled in it , determine six uniformly distributed initial sample points X 1 =[1,3], X 2 =[1,6], X 3 =[3,3], X 4 =[3,6], X 5 =[ 5,3], X 6 =[5,6];

步骤S12、在上述机械抽样的6个初始样本点中取一个未选取过的初始样本点,设置为当前踝关节外骨骼PD控制器的参数,规定穿戴者在当前工况中进行步行运动,完成完整的12个步态周期,并记录过程中的控制误差em,m=1,2,…,12;Step S12: Take an unselected initial sample point from the 6 initial sample points in the above-mentioned mechanical sampling, set it as the parameter of the PD controller of the current ankle joint exoskeleton, and stipulate that the wearer should perform walking exercise in the current working condition, and complete Complete 12 gait cycles, and record the control error e m during the process, m=1,2,...,12;

步骤S13、对已记录的控制误差在每个步态周期内作均匀的样条插值,得到12个具有100个元素的控制误差序列{em,i,m=1,2,…,12|i=1,2,…,100};Step S13: Perform uniform spline interpolation on the recorded control errors in each gait cycle to obtain 12 control error sequences with 100 elements {e m,i ,m=1,2,...,12| i=1,2,...,100};

步骤S14、对每个步态周期的控制误差序列计算一个评估指数Em,并平均得到平均评估指数

Figure BDA0003877851390000101
具体方法可以参照实施例1的步骤S14;Step S14, calculating an evaluation index E m for the control error sequence of each gait cycle, and averaging to obtain the average evaluation index
Figure BDA0003877851390000101
The specific method can refer to step S14 of embodiment 1;

步骤S15、重复步骤S12至步骤S14,直至6个初始样本点均被选取,最终得到初始样本点Xn对应的平均评估指数

Figure BDA0003877851390000102
Step S15, repeat step S12 to step S14 until all 6 initial sample points are selected, and finally obtain the average evaluation index corresponding to the initial sample point X n
Figure BDA0003877851390000102

在本实施例中,步骤S1建立的外骨骼PD控制器参数整定的初始样本集如表3所示。In this embodiment, the initial sample set for parameter tuning of the exoskeleton PD controller established in step S1 is shown in Table 3.

表3.实施例2的参数整定初始样本集Table 3. The parameter tuning initial sample set of embodiment 2

Figure BDA0003877851390000103
Figure BDA0003877851390000103

Figure BDA0003877851390000111
Figure BDA0003877851390000111

步骤S2、将初始样本集在内的现有样本集作为训练数据,导入高斯回归算法中进行训练,重复求解最优样本点直至满足收敛条件,确定最优比例系数Kp和微分系数Kd取值作为踝关节外骨骼PD控制器的参数整定结果,具体内容可以参照实施例中的步骤S2,在本实施例中,步骤S2过程中得到的过程样本集如表4所示,Step S2, use the existing sample set including the initial sample set as training data, import it into the Gaussian regression algorithm for training, repeatedly solve the optimal sample point until the convergence condition is met, and determine the optimal proportional coefficient K p and differential coefficient K d value as the parameter tuning result of the ankle exoskeleton PD controller, the specific content can refer to step S2 in the embodiment, in the present embodiment, the process sample set obtained in the step S2 process is as shown in Table 4,

表4.实施例2的参数整定过程样本集表Table 4. The parameter tuning process sample set table of embodiment 2

Figure BDA0003877851390000112
Figure BDA0003877851390000112

过程样本次序5的样本点与过程样本次序6的样本点之间的欧式距离小于1,则说明已收敛,且比较过程样本次序5和过程样本次序5的平均评估指数

Figure BDA0003877851390000113
最后选取过程样本次序5的样本点为最优点,该点比例系数Kp和微分系数Kd取值作为本实施例的踝关节外骨骼PD控制器的参数整定结果。本实施例更改了实施例1中的初始样本数据,通过人机在环调试的踝关节外骨骼PD控制器参数整定方法,经过数次的参数整定迭代过程最终都得到了最优的PD控制器参数,进一步证明了本发明的技术效果。If the Euclidean distance between the sample point of process sample order 5 and the sample point of process sample order 6 is less than 1, it means that it has converged, and compare the average evaluation index of process sample order 5 and process sample order 5
Figure BDA0003877851390000113
Finally, the sample point of process sample sequence 5 is selected as the optimal point, and the values of the proportional coefficient K p and the differential coefficient K d of this point are used as the parameter setting results of the ankle exoskeleton PD controller in this embodiment. In this embodiment, the initial sample data in Embodiment 1 is changed, and the optimal PD controller is finally obtained after several iterations of parameter setting through the man-machine-in-the-loop debugging ankle exoskeleton PD controller parameter setting method. Parameters further prove the technical effect of the present invention.

综上所述,本实施例公开了一种人机在环的踝关节外骨骼PD控制器参数整定方法。针对不同的穿戴者和步行工况会影响最优控制效果时的PD控制器的Kp和Kd参数这一技术难题,本实施例的人机在环参数整定方法可用于不同的穿戴者和行走工况的条件下整定踝关节外骨骼的PD控制器参数使控制效果达到最优,整定过程通过人机在环的在线调节,无须特定测试环境或设备的介入。本实施例的人机在环的参数整定方法仅依靠外骨骼及其上位机(PC端、移动端、MCU等)的计算,不依赖其他外界的特定测试环境和设备,能快捷且有针对性地对踝关节外骨骼PD控制器进行参数整定。To sum up, the present embodiment discloses a method for parameter setting of a man-machine-in-the-loop ankle exoskeleton PD controller. Aiming at the technical problem of Kp and Kd parameters of the PD controller when different wearers and walking conditions will affect the optimal control effect, the human-machine-in-the-loop parameter tuning method of this embodiment can be used for different wearers and walking conditions . The parameters of the PD controller of the ankle exoskeleton are adjusted under the walking condition to achieve the optimal control effect. The tuning process is adjusted online by man-machine-in-the-loop, without the intervention of specific test environments or equipment. The man-machine-in-the-loop parameter setting method of this embodiment only relies on the calculation of the exoskeleton and its host computer (PC terminal, mobile terminal, MCU, etc.), and does not rely on other specific external test environments and equipment, which can be fast and targeted The parameters of the ankle exoskeleton PD controller are tuned accordingly.

上述实施例为本发明较佳的实施方式,但本发明的实施方式并不受上述实施例的限制,其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化,均应为等效的置换方式,都包含在本发明的保护范围之内。The above-mentioned embodiment is a preferred embodiment of the present invention, but the embodiment of the present invention is not limited by the above-mentioned embodiment, and any other changes, modifications, substitutions, combinations, Simplifications should be equivalent replacement methods, and all are included in the protection scope of the present invention.

Claims (4)

1.一种人机在环调试的踝关节外骨骼PD控制器参数整定方法,其特征在于,所述参数整定方法包括如下步骤:1. An ankle joint exoskeleton PD controller parameter tuning method of man-machine in-loop debugging, it is characterized in that, described parameter tuning method comprises the steps: 步骤S1、选取初始PD控制器参数,通过记录外骨骼在当前PD控制器参数下的辅助力控制误差,建立外骨骼PD控制器参数整定的初始样本集;Step S1, select initial PD controller parameters, and establish an initial sample set for exoskeleton PD controller parameter tuning by recording the assist force control error of the exoskeleton under the current PD controller parameters; 步骤S2、将初始样本集在内的现有样本集作为训练数据,导入高斯回归算法中进行训练,重复求解最优样本点直至满足收敛条件,确定最优比例系数Kp和微分系数Kd取值作为踝关节外骨骼PD控制器的参数整定结果。Step S2, use the existing sample set including the initial sample set as training data, import it into the Gaussian regression algorithm for training, repeatedly solve the optimal sample point until the convergence condition is met, and determine the optimal proportional coefficient K p and differential coefficient K d The value is used as the parameter tuning result of the ankle exoskeleton PD controller. 2.根据权利要求1所述的一种人机在环的踝关节外骨骼PD控制器参数整定方法,其特征在于,所述步骤S1过程如下:2. a kind of human-machine-in-the-loop ankle exoskeleton PD controller parameter tuning method according to claim 1, is characterized in that, described step S1 process is as follows: S11、规定PD控制器的比例系数Kp和微分系数Kd的初始定义域分别为[0,p0]及[0,d0],在[0,p0]及[0,d0]中分别以a0和b0的步长采样,作为初始样本集,得到初始样本点点阵{X=[Kp,Kd],Kp∈{0,a0,2a0,...,p0},Kd∈{0,b0,2b0,...,d0}},在初始样本点点阵中做机械抽样,确定N个均匀分布的初始样本点Xn,n=1,2,...,N;S11. It is stipulated that the initial definition domains of the proportional coefficient K p and the differential coefficient K d of the PD controller are [0, p 0 ] and [0, d 0 ] respectively, in [0, p 0 ] and [0, d 0 ] Sampling at the step size of a 0 and b 0 respectively, as the initial sample set, to obtain the initial sample point matrix {X=[K p , K d ], K p ∈ {0, a 0 , 2a 0 ,..., p 0 }, K d ∈ {0, b 0 , 2b 0 ,..., d 0 }}, do mechanical sampling in the initial sample point lattice, and determine N uniformly distributed initial sample points X n , n=1 ,2,...,N; S12、在上述机械抽样的N个初始样本点中取一个未选取过的初始样本点,设置为当前踝关节外骨骼PD控制器的参数,规定穿戴者在当前工况中进行步行运动,完成完整的M个步态周期,并记录过程中的控制误差em,m=1,2,...,M;S12. Take an unselected initial sample point from the N initial sample points in the above-mentioned mechanical sampling, and set it as the parameter of the PD controller of the current ankle joint exoskeleton, and stipulate that the wearer can walk in the current working condition to complete the complete M gait cycles of , and record the control error em during the process, m =1, 2,..., M; S13、对已记录的控制误差在每个步态周期内作均匀的样条插值,得到M个具有100个元素的控制误差序列{em,i,m=1,2,...,M|i=1,2,...,100},其中em,i表示控制误差第m个步态周期的第i个元素;S13. Perform uniform spline interpolation on the recorded control error in each gait cycle to obtain M control error sequences {e m, i , m=1, 2, ..., M with 100 elements |i=1, 2,..., 100}, where e m, i represent the i-th element of the m-th gait cycle of the control error; S14、对每个步态周期的控制误差序列计算评估指数Em,Em表示第m个步态周期的评估指数,计算方式如下:S14. Calculate the evaluation index E m for the control error sequence of each gait cycle, where E m represents the evaluation index of the mth gait cycle, and the calculation method is as follows:
Figure FDA0003877851380000021
Figure FDA0003877851380000021
其中Fi为控制误差发生时对应的目标踝关节辅助力矩大小,计算得到M个评估指数Em,m=1,2,...,M,然后对M个评估指数求平均得到平均评估指数
Figure FDA0003877851380000022
Among them, F i is the corresponding target ankle joint auxiliary moment when the control error occurs, and M evaluation indexes E m are calculated, m=1, 2,..., M, and then the average evaluation index is obtained by averaging the M evaluation indexes
Figure FDA0003877851380000022
S15、重复步骤S12至步骤S14,直至N个初始样本点均被选取,最终得到初始样本点Xn对应的平均评估指数
Figure FDA0003877851380000023
n=1,2,...,N,其中
Figure FDA0003877851380000024
表示第n个初始样本点的平均评估指数
Figure FDA0003877851380000025
S15. Repeat steps S12 to S14 until N initial sample points are selected, and finally obtain the average evaluation index corresponding to the initial sample point X n
Figure FDA0003877851380000023
n=1,2,...,N, where
Figure FDA0003877851380000024
Indicates the average evaluation index of the nth initial sample point
Figure FDA0003877851380000025
3.根据权利要求2所述的一种人机在环的踝关节外骨骼PD控制器参数整定方法,其特征在于,所述步骤S2过程如下:3. a kind of man-machine-in-the-loop ankle joint exoskeleton PD controller parameter tuning method according to claim 2, is characterized in that, described step S2 process is as follows: S21、将包括初始样本点在内的现有全部样本点导入高斯回归算法进行训练,其中将当前PD控制器的参数Xn=[Kp,Kd]作为自变量,将平均评估指数
Figure FDA0003877851380000026
作为因变量,并基于最大似然法,使用牛顿法或共轭梯度法等非线性数值优化算法来寻优高斯回归算法的超参数,使之最匹配现有样本集的真值分布和噪声分布,然后回归得到自变量与因变量的拟合曲面;
S21. Import all existing sample points including the initial sample points into the Gaussian regression algorithm for training, wherein the parameter X n = [K p , K d ] of the current PD controller is used as an independent variable, and the average evaluation index
Figure FDA0003877851380000026
As a dependent variable, and based on the maximum likelihood method, use nonlinear numerical optimization algorithms such as Newton method or conjugate gradient method to optimize the hyperparameters of the Gaussian regression algorithm so that it best matches the true value distribution and noise distribution of the existing sample set , and then regression to obtain the fitting surface of the independent variable and the dependent variable;
S22、在经训练好的高斯回归算法得到的拟合曲面上逐一检索点阵上每一点的预测因变量,得到预测因变量最小值所处的当前最优样本点xopt=[Kpopt,Kdopt],其中Kpopt和Kdopt分别为PD控制器的比例系数Kp和微分系数Kd的当前最优参数取值;S22. Retrieve the predicted dependent variable of each point on the lattice one by one on the fitted surface obtained by the trained Gaussian regression algorithm, and obtain the current optimal sample point where the minimum value of the predicted dependent variable is located x opt = [K popt , K dopt ], where K popt and K dopt are the current optimal parameter values of the proportional coefficient K p and the differential coefficient K d of the PD controller respectively; S23、将该当前最优参数取值Kpopt和Kdopt作为新的比例系数Kp和微分系数Kd设置为当前踝关节外骨骼PD控制器的参数,规定穿戴者在当前工况中进行步行运动,完成完整的M个步态周期,并记录过程中的控制误差em,m=1,2,...,M;S23. Set the current optimal parameter values K popt and K dopt as the new proportional coefficient K p and differential coefficient K d as the parameters of the current ankle exoskeleton PD controller, and stipulate that the wearer can walk in the current working condition Movement, complete M complete gait cycles, and record the control error em during the process, m =1, 2,..., M; S24、重复步骤S13到S14,得到的平均评估指数
Figure FDA0003877851380000031
为当前最优样本点xopt的平均评估指数;
S24. Repeat steps S13 to S14 to obtain the average evaluation index
Figure FDA0003877851380000031
is the average evaluation index of the current optimal sample point x opt ;
S25、将当前最优样本点xopt=[kpopt,kdopt]记录为新的样本点,与初始样本点共同组成为现有样本集,若现有样本集中已有的任意一样本点与新的样本点的欧式距离小于一定阈值,则选择该点和新的样本点两者之间平均评估指数
Figure FDA0003877851380000032
最小者为最优,平均评估指数
Figure FDA0003877851380000033
最小者的比例系数Kp和微分系数Kd取值作为踝关节外骨骼PD控制器的参数整定结果。
S25. Record the current optimal sample point x opt = [k popt , k dopt ] as a new sample point, and form the existing sample set together with the initial sample point. If any sample point in the existing sample set is the same as If the Euclidean distance of the new sample point is less than a certain threshold, then select the average evaluation index between the point and the new sample point
Figure FDA0003877851380000032
The smallest is the best, the average evaluation index
Figure FDA0003877851380000033
The value of the smallest proportional coefficient K p and differential coefficient K d is used as the parameter tuning result of the ankle exoskeleton PD controller.
4.根据权利要求3所述的一种人机在环的踝关节外骨骼PD控制器参数整定方法,其特征在于,所述步骤S25中还包括:4. a kind of man-machine-in-the-loop ankle joint exoskeleton PD controller parameter tuning method according to claim 3, is characterized in that, also comprises in the described step S25: 步骤S25.1、若新的样本点不处于定义域的边界上,且与样本集中任意某一点的欧氏距离小于一定阈值,说明已达到收敛,选择该任意某一点和新的样本点两者之间平均评估指数
Figure FDA0003877851380000034
最小者为最优,平均评估指数
Figure FDA0003877851380000035
最小者的比例系数Kp和微分系数Kd取值作为踝关节外骨骼PD控制器的参数整定结果;
Step S25.1. If the new sample point is not on the boundary of the definition domain, and the Euclidean distance to any point in the sample set is less than a certain threshold, it means that convergence has been achieved, and the arbitrary point and the new sample point are selected. average evaluation index
Figure FDA0003877851380000034
The smallest is the best, the average evaluation index
Figure FDA0003877851380000035
The value of the smallest proportional coefficient K p and differential coefficient K d is used as the parameter tuning result of the ankle exoskeleton PD controller;
步骤S25.2、若新的样本点不处于定义域的边界上,且与样本集中任意一点的欧氏距离均不小于一定阈值,则从步骤S21开始再按顺序执行流程步骤;Step S25.2. If the new sample point is not on the boundary of the defined domain, and the Euclidean distance from any point in the sample set is not less than a certain threshold, then start from step S21 and then execute the process steps in order; 步骤S25.3、若新的样本点处于比例系数Kp和微分系数Kd的定义域边界上,则将定义域向该边界外扩展一定距离Δl形成新的定义域[0,p]及[0,d]后,从步骤S21开始再按顺序执行流程步骤。Step S25.3, if the new sample point is on the domain boundary of the proportional coefficient Kp and the differential coefficient Kd, expand the domain to a certain distance Δl outside the boundary to form a new domain [0, p ] and [ 0, d], start from step S21 and then execute the process steps in sequence.
CN202211222151.2A 2022-10-08 2022-10-08 Ankle joint exoskeleton PD controller parameter setting method for man-machine on-loop debugging Active CN115542723B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202211222151.2A CN115542723B (en) 2022-10-08 2022-10-08 Ankle joint exoskeleton PD controller parameter setting method for man-machine on-loop debugging

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211222151.2A CN115542723B (en) 2022-10-08 2022-10-08 Ankle joint exoskeleton PD controller parameter setting method for man-machine on-loop debugging

Publications (2)

Publication Number Publication Date
CN115542723A true CN115542723A (en) 2022-12-30
CN115542723B CN115542723B (en) 2024-08-30

Family

ID=84732397

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211222151.2A Active CN115542723B (en) 2022-10-08 2022-10-08 Ankle joint exoskeleton PD controller parameter setting method for man-machine on-loop debugging

Country Status (1)

Country Link
CN (1) CN115542723B (en)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2021007812A1 (en) * 2019-07-17 2021-01-21 深圳大学 Deep neural network hyperparameter optimization method, electronic device and storage medium
CN112711838A (en) * 2020-12-23 2021-04-27 华南理工大学 Electric energy cost estimation method for ankle joint flexible walking exoskeleton
CN112932898A (en) * 2021-01-28 2021-06-11 东南大学 On-demand auxiliary rehabilitation robot training method based on Bayesian optimization

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2021007812A1 (en) * 2019-07-17 2021-01-21 深圳大学 Deep neural network hyperparameter optimization method, electronic device and storage medium
CN112711838A (en) * 2020-12-23 2021-04-27 华南理工大学 Electric energy cost estimation method for ankle joint flexible walking exoskeleton
CN112932898A (en) * 2021-01-28 2021-06-11 东南大学 On-demand auxiliary rehabilitation robot training method based on Bayesian optimization

Also Published As

Publication number Publication date
CN115542723B (en) 2024-08-30

Similar Documents

Publication Publication Date Title
CN110238839B (en) Multi-shaft-hole assembly control method for optimizing non-model robot by utilizing environment prediction
CN109514553B (en) Method, system and equipment for robot movement control
Ren et al. An optimal neural network and concrete strength modeling
CN118571415A (en) Optimization method of personalized postoperative rehabilitation training program for breast cancer based on machine learning
CN118918638A (en) Burn patient rehabilitation training intelligent guidance system based on deep learning
CN101872444A (en) A Batch-to-Batch Optimization Method for Batch Processes Combined with Mid-Term Correction Strategies
CN116604532A (en) Intelligent control method for upper limb rehabilitation robot
CN114626505A (en) Mobile robot deep reinforcement learning control method
Shao et al. Deep reinforcement learning assisted surrogate model management for expensive constrained multi-objective optimization
CN109143853B (en) Self-adaptive control method for liquid level of fractionating tower in petroleum refining process
CN119310841A (en) A triple optimized SAC reinforcement learning method for continuous robot control
CN111515938A (en) A walking trajectory tracking method of lower limb exoskeleton based on inheritance iterative learning control
CN115542723A (en) Parameter setting method for ankle exoskeleton PD controller for man-machine in-loop debugging
JP2024069862A (en) Learning device, learning method and recording medium
CN107728481B (en) A closed-loop modeling method and device based on model predictive control
TW201322149A (en) Method of establishing system equivalent model combined with Volterra system and its computer program product
CN109635915A (en) An Iterative Learning Control Method Based on Equilibrium Single Evolutionary Cuckoo Algorithm
CN114770523B (en) Robot control method based on offline environment interaction
CN118859952A (en) A multi-robot dynamic task planning method based on meta-reinforcement learning
CN118674001A (en) State action relation reinforcement learning method integrating graph convolution and large language model
Pedrocchi et al. Error mapping controller: a closed loop neuroprosthesis controlled by artificial neural networks
CN116578024A (en) Multi-mode control method and system for rehabilitation robot based on mixed mode signals
CN114839874A (en) A parallel control method and system for partially unknown system model
TWI887143B (en) Computing method for obtaining slack variables in an objective function
Huang et al. Closed loop iterative learning control for consistency tracking in lower limb rehabilitation robotic system with initial state deviations

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
点击 这是indexloc提供的php浏览器服务,不要输入任何密码和下载