超声波钻谐振控制算法设计及试验验证

2024-04-13全齐全金亦康张秋葵唐德威邓宗全

哈尔滨工业大学学报 2024年4期

全齐全,金亦康,张秋葵,唐德威,邓宗全

(机器人技术与系统国家重点实验室(哈尔滨工业大学),哈尔滨 150001)

迄今为止,小行星探测器对小行星的探测大多采用飞掠探测或一触即离的方式,只能得到表层的信息和样本[1-9]。获取小行星的深层样本需要探测器可靠地锚固在小行星表面[10],在各锚固方案中,通过钻机钻进实现几何力封闭的锚固方式具有较高的可靠性和较好的地质适应性。传统的钻机需要施加较大的钻压力和力矩,消耗功率大,探测器较难满足这些条件[11],超声波钻工作时钻压力小、功耗小,几乎不对机架产生附加力矩,并且能够适应地外空间的工作环境,适合应用在探测器的钻进锚固工作中。

超声波钻基于超声波换能器的逆压电效应工作,换能器工作时需要使驱动信号位于谐振频率区间[12-13],否则换能器未处于谐振状态时端面振幅过小,无法实现冲击钻进,因此需要对换能器的谐振频率进行辨识。此外,换能器的电品质因数较高,谐振频率经常受到温度、湿度等环境参数的影响而漂移[14-15],在工作过程中需要对谐振频率进行跟踪。在超声波应用常见的频率跟踪算法中,锁相控制有良好的稳定性,对扰动信号的抗干扰能力较强[16],但是需要让换能器谐振点的相角不发生变化,而超声波钻在工作时温度的变化会使谐振点的相角发生改变,并且换能器的阻抗特性参数对负载较敏感,因此锁相控制不适合应用于超声波钻的谐振控制中。扫频控制能够较可靠地跟踪谐振点,但是工作过程中需要对区间不断扫描,影响了频率跟踪速度和超声波钻的工作效率[17-18]。极值搜索控制能够自适应地跟踪于换能器的特性参数极值点,具有良好的鲁棒性、收敛速度快等优点[19]。本文利用超声波钻的谐振点与最小阻抗点的对应关系,研究超声波钻的谐振控制算法,高效稳定驱动超声波钻,并通过试验进行验证。

1 超声波钻锚固方案及工作特性分析

1.1 超声波钻钻进锚固方案

利用超声波钻进行交叉钻进的锚固方案如图1所示,超声波钻安装小行星探测器着陆腿上,在探测器提供较低的钻压力作用下,超声波钻对星岩进行交叉钻进,形成几何力封闭的锚固形式,使探测器锚固在小行星表面。

图1 超声波钻锚固方案Fig.1 Anchoring scheme with ultrasonic drill

1.2 超声波钻工作原理分析

超声波钻的结构如图2所示,超声波钻由超声波换能器和钻具组成,超声波换能器由后盖板、压电陶瓷、前盖板和变幅杆构成,前、后盖板通过螺纹连接压紧压电陶瓷;钻具由钻杆、预紧装置、回复弹簧、自由质量块和钻套构成,预紧装置通过回复弹簧将钻杆和自由质量块压在换能器端面,通过紧钉螺钉固定预紧装置,避免在工作时旋出。

图2 超声波钻结构Fig.2 Structure of ultrasonic drill

超声波钻的工作原理如图3所示,基于压电陶瓷的逆压电效应,将激励交流信号转化为高频机械振动,变幅杆将振幅进一步放大,换能器的端面振动冲击自由质量块,自由质量块在换能器和钻杆间往复运动,使钻杆冲击岩石实现钻进。

图3 超声波钻工作原理Fig.3 Working principle of ultrasonic drill

1.3 换能器阻抗特性分析

基于BVD等效模型建立超声波换能器的等效电路模型如图4所示,静态支路的静态电容C0由换能器自身品质决定,动态支路由动态电感L1、动态电容C1和动态电阻R1构成,分别表示换能器工作时的惯性、弹性和能量损耗。

图4 超声波换能器等效电路模型Fig.4 Equivalent circuit model of ultrasonic transducer

超声波换能器的电压-速度传递函数Y为

(1)

式中:p为超声波换能器的机电耦合系数,ω为驱动信号角频率。

为了使钻进速率最大化,驱动信号的频率应使Y最大,则最优驱动频率fs为

(2)

此时驱动频率为换能器的串联谐振频率,动态支路呈现纯阻性,受到静态电容的影响,换能器整体呈现容性。通过阻抗分析仪分析发现换能器的最小阻抗频率与串联谐振频率基本相符,以此建立超声波钻最小阻抗点与最优工作点的对应关系。

1.4 换能器负载特性分析

超声波换能器在空载状态下的阻抗特性曲线如图5所示,最小阻抗值为139.44 Ω,对应的驱动频率为19.905 kHz,对应相角为-16.662°。空载下的阻抗曲线作为负载变化后的参考曲线,研究负载对换能器阻抗特性的影响。

图5 空载时换能器阻抗曲线Fig.5 Impedance curve of transducer without load

对超声波换能器端面分别施加12 N和24 N的负载,阻抗曲线分别如图6(a)、6(b)所示,负载为12 N时,最小阻抗值为223.93 Ω,对应的驱动频率为20.057 kHz,对应相角为-33.153°;负载为24 N时,最小阻抗值为292.04 Ω,对应的驱动频率为20.201 kHz,对应相角为-42.715°。

图6 带载时换能器阻抗曲线Fig.6 Impedance curve of transducer with load

对比空载和负载时换能器的阻抗曲线可以看出,当负载增大时,换能器的阻抗增大,谐振频率增大,对应的相角值增大。超声波钻在工作时自由质量块对换能器端面的冲击使换能器的负载变化剧烈,并且负载变化无规律。在对超声波钻的谐振频率进行跟踪时,由负载变化导致的阻抗特性参数变化应通过滤波处理去除。

1.5 换能器温度特性分析

超声波钻在工作时自身的发热会导致换能器温度上升,需要研究温度变化对换能器特性参数的影响。利用高低温实验箱在-60～120 ℃温度范围内每隔30 ℃设置一次工作环境,测试不同温度下超声波钻工作时换能器的特性参数,测试结果见表1,从测试结果可以看出,当换能器的温度上升时,谐振频率减小,阻抗值和相角值增大,工作性能下降。为了使换能器工作时处于相对较好的谐振状态,应对温度变化引起的谐振频率漂移进行跟踪。

表1 不同温度下换能器特性参数Tab.1 Transducer characteristic parameters at different temperatures

1.6 换能器滞后特性分析

超声波钻的组成中存在机械系统,工作过程中阻抗特性曲线存在滞后特性,若在对谐振频率进行跟踪时忽略这一特性,容易使超声波钻长时间工作在低效率状态,导致钻进速率不理想。

装上钻具后利用阻抗分析仪预先得到谐振频率值,以此设定频率扫频的区间,在该区间内,分别以频率减小和频率增大的方向进行频率扫频,得到两个方向的阻抗曲线如图7所示,以最小阻抗点为谐振频率,从图7(a)可以看出,两个频率变化方向的谐振频率不同,以相角跳变点为换能器失去和进入谐振状态的判定依据从图7(b)可以看出,频率减小方向失去谐振状态的频率点和频率增大方向进入谐振状态的频率点不同。

图7 换能器滞后特性曲线Fig.7 Hysteresis characteristic curve of transducer

以频率减小方向得到的最小阻抗值更小,可以取得更好驱动效果,所以在实际控制时应该以频率减小的方向进入谐振状态。

2 超声波钻谐振控制算法设计

为使超声波钻获得最佳驱动状态,需要设计相应的谐振控制算法,识别超声波钻的谐振频率并在工作过程中对变化的谐振频率进行跟踪。

2.1 谐振控制整体方案设计

设计超声波钻谐振控制整体方案流程图如图8所示,启动驱动电源时,初始化起始参数,通过对最小阻抗点的识别判断初始状态下的谐振频率。钻进过程中,为了实现对谐振频率的跟踪,采集换能器的阻抗参数信号,经过信号处理后通过谐振频率跟踪算法进行判定决策输出频率变化量。

图8 超声波钻谐振控制流程Fig.8 Flow chart of ultrasonic drill resonance control

自由质量块对换能器端面的冲击性负载会影响阻抗特性参数,使谐振点附近的阻抗曲线存在较多的局部最小值,在识别超声波钻的谐振频率时,采用频率扫描算法对预设定区间内的频率进行遍历,记录区间内的最小阻抗点对应的频率为初始状态下的谐振频率。对谐振频率进行跟踪时,在对阻抗极值点的跟踪原理上提出了基于递归最小二乘估计的谐振频率跟踪算法和基于模糊控制的谐振频率跟踪算法,通过试验对两种算法的实际跟踪效果进行对比后选择跟踪效果更好的控制算法。

2.2 谐振频率识别算法设计

频率扫描算法的工作流程如图9所示,在阻抗分析仪的分析基础上设定频率扫描区间[f1,f2],由换能器的滞后特性可知以频率下降的方向进入谐振状态可以获得更好驱动效果,因此将f2作为起始驱动频率,每个采样周期采集驱动频率对应的换能器阻抗值并将驱动频率减小Δf,当换能器阻抗值接近最小阻抗值时,减小频率变化步长以获得更精确的谐振频率值,当驱动频率小于f2且当前换能器相角值大于80°时,认为已经对谐振区间完成扫描,以频率扫描区间内最小阻抗点对应的驱动频率为初始状态的谐振频率。

图9 频率扫描算法工作流程Fig.9 Flow chart of frequency scanning algorithm

2.3 谐振频率跟踪算法设计

在工作过程中超声波钻受工况和温升的影响谐振频率会发生漂移,在频率扫描算法识别出超声波钻的谐振频率后,还需设计频率跟踪算法实时跟踪谐振频率。

2.3.1 基于递归最小二乘估计的频率跟踪算法

基于递归最小二乘估计的频率跟踪算法主要包含爬山算法和递归最小二乘法两部分,其工作流程图如图10所示,在频率扫描算法给定起始驱动频率之后,由爬山算法继续对谐振频率进行跟踪并在谐振点两侧振荡,在爬山算法控制驱动频率阶段,输出的驱动频率值和采样反馈的阻抗值将作为递归最小二乘估计算法的输入,对谐振点邻域阻抗曲线的局部数学模型进行参数辨识,当估计收敛后,由递归最小二乘估计算法控制驱动频率,并不断更新估计算法的输入以实现对谐振频率的精确跟踪。

图10 基于递归最小二乘估计的频率跟踪算法Fig.10 Frequency tracking algorithm based on RLS

爬山算法工作时,需要设定步进方向和步长大小。考虑爬山算法并不用于精确跟踪谐振频率,步长大小采用定步长的方式;步进方向由当前控制周期和上一控制周期的阻抗值大小关系决定,当前周期阻抗值比上一周期小时,说明步进方向正确,继续按当前方向改变驱动频率,当前周期阻抗值比上一周期大时,步进方向错误,反向改变驱动频率。

递归最小二乘法对谐振频率的辨识需要建立换能器阻抗曲线的数学模型,爬山算法在工作时驱动频率在谐振频率周围振荡,因此只需建立换能器在谐振点周围的局部数学模型:

Z(t)=Z0+a(f(t)-f0)2

(3)

式中:Z(t)、Z0、a、f(t)、f0分别为换能器阻抗、最小阻抗点阻抗值、二次项系数、驱动频率、谐振频率,其中Z(t)、f(t)为输入量,Z0、a、f0需要进行辨识。

其中为避免估计过程中常数项Z0在估计过程中有效位数带来的数值问题,同时减少需要估计的参数量,将模型改为增量形式:

y(t)=-2af0Δf(t)+aΔf2(t)

(4)

记φ(k)为数据向量,θ为待估计参数向量

(5)

对于L次观测的代价函数J为

(6)

推导得到参数估计的递推公式为

(7)

则谐振频率的估计量为

(8)

为了在工作过程中持续对谐振频率进行辨识,需要不断获取估计算法的输入数据,因此在输出驱动频率时需要在估计量基础上加上一个小扰动激励信号fpert,例如幅值较小的正弦信号,则实际输出的驱动频率值fout为

(9)

2.3.2 基于模糊控制的频率跟踪算法

从换能器的滞后特性分析中可以总结出超声波钻的滞回曲线如图11所示,fs为最小阻抗点,处于相角的跳变位置,在工作过程中容易受到负载变化的影响而使相角发生跳变,从而让超声波钻失去谐振状态,为保证超声波钻工作的稳定性,在对目标跟踪点的选取时,应该使目标点ftgt偏置于最小阻抗频率一定值,图11中fbias为频率偏置量。当超声波钻失去谐振状态时,应根据图11中的滞回曲线,设计相应的决策快速回到谐振状态。

图11 超声波钻滞回曲线Fig.11 Hysteresis curve of ultrasonic drill

根据超声波钻的滞后特性,提出基于模糊控制的谐振频率跟踪算法,其工作流程如图12所示,通过频率扫描算法设定初始状态的驱动频率和目标阻抗值,采集换能器信号并计算阻抗及相角值,当相角大于80°时,说明已经失去谐振状态,此时应根据阻抗滞回曲线将驱动频率增加一定值后再减小,使超声波钻快速回到谐振状态,同时增大目标阻抗值,以提升驱动的稳定性;当65°<θ<80°时,超声波钻处于临近失谐状态,若再改变驱动频率容易导致超声波钻失去谐振状态,应使驱动频率保持不变;若超声波钻在计时器计时到t的过程中都没有失去谐振状态,认为驱动状态已经比较稳定,使目标阻抗值降低一定值获得更好驱动效果;相角小于65°时,驱动频率处于谐振区间,为跟踪驱动效果较好的谐振频率,以当前控制周期的阻抗值和目标阻抗值的偏差以及偏差的变化率为模糊控制器的输入,输出驱动频率的变化量,对目标阻抗值进行跟踪,使换能器保持在较低的阻抗值。

图12 基于模糊控制的频率跟踪算法Fig.12 Frequency tracking algorithm based on fuzzy control

分析换能器在谐振点邻域的阻抗变化范围、阻抗和频率变化的比值、驱动频率的变化范围确定模糊控制器输入和输出的基本论域,设计模糊子集的论域为[-6,-5,-4,-3,-2,-1,0,1,2,3,4,5,6],设计模糊语言集合为[NB,NM,NS,ZO,PS,PM,PB],根据实际试验数据设计输入输出的隶属函数如图13、14所示。

图13 E/df隶属函数Fig.13 E/df membership function

图14 EC隶属函数Fig.14 EC membership function

根据实际试验数据设计模糊控制规则(见表2),采用Mamdani决策法,解模糊采用加权平均法。

表2 模糊控制规则Tab.2 Fuzzy control rules

2.3.3 算法跟踪效果对比

记基于递归最小二乘估计的频率跟踪算法为控制方案1、基于模糊控制的频率跟踪算法为控制方案2,对两种频率跟踪算法的控制效果进行对比,结果如图15所示,两种控制算法都可以对最小阻抗点进行跟踪,但是控制方案1跳变幅度较大,控制方案2跟踪稳定性更好,因此选择控制方案2作为谐振频率跟踪算法。

图15 频率跟踪效果对比Fig.15 Frequency tracking effect comparison

2.4 恒电流控制算法设计

超声波换能器的端面振幅和其两端电流的大小成正比,为了使实现超声波钻更加稳定驱动,研究了恒电流控制算法。采集换能器的电流信号,与参考电流之做差得到电流偏差值,通过PID算法实现恒电流控制。

超声波钻的驱动电源主控芯片为现场可编程门阵列芯片(field programmable gate array,FPGA),需要将连续系统的PID转化为离散形式。

连续系统PID为

(10)

式中:u(t)、e(t)、kp、Ti、Td分别为输出量、偏差值、比例系数、积分时间常数、微分时间常数。

在采样周期T的条件下,积分项和微分项做如下处理:

(11)

得到离散后PID公式为

(12)

式中:ki=kpT/Ti,kd=kpTd/T。

为了优化驱动程序的存储资源占用,将式(12)改写为增量形式:

u(k)=u(k-1)+k0e(k)+k1e(k-1)+k2e(k-2)

(13)

式中:k0=kp+ki+kd,k1=-kp-2kd,k2=kd。

采用并行设计的思想构建增量式PID结构如图16所示,3个乘法器和4个加法器同时工作,提高了算法的计算速度。

图16 增量式PID结构Fig.16 Incremental PID structure

3 超声波钻谐振控制试验验证

设计驱动程序在超声波钻驱动电源中实现设计的控制算法,并通过试验对控制效果进行验证。

3.1 试验装置与条件

超声波钻的钻进试验在如图17所示的钻进实验台上进行,实验台由底座、导轨支架和砝码组成,岩石被切割为100 mm×100 mm×50 mm的立方体通过螺钉固定在实验台一侧,超声波钻安装在支架上,通过导轨滑块与底座相连,由砝码拉动支架提供钻进时的钻压力。

图17 超声波钻钻进实验台Fig.17 Ultrasonic drilling test bench

超声波钻的钻进试验环境如图18所示,通过设计的驱动电源驱动超声波钻工作,上位机用于设计驱动程序烧录至驱动电源并对驱动电源上传的采样信号进行处理,可调电源为驱动电源提供28 V直流电,通过示波器测试驱动电源的输出激励信号。

图18 超声波钻钻进试验环境Fig.18 Ultrasonic drilling test environment

3.2 恒电流控制试验

在对谐振频率跟踪的前提下,对恒电流控制的控制效果进行试验验证,试验结果如图19所示,在没有恒定电流控制时,即使驱动电源跟踪于谐振频率,超声波换能器在工作过程中状态发生改变,导致换能器两端电流下降,恒电流控制可以使换能器两端电流保持相对稳定,电流变化范围小于0.06 A。

图19 换能器电流对比Fig.19 Transducer current comparison

在有恒电流控制和没有恒电流控制的条件下分别测试换能器的端面振幅,试验结果如图20所示,对试验结果进行分析计算,恒电流控制可以抑制换能器端面振幅26.7%的衰减。

图20 换能器端面振幅对比Fig.20 Amplitude comparison of transducer end face

3.3 谐振频率跟踪试验

为了验证谐振频率跟踪算法的跟踪效果,分别采用固定驱动频率和频率跟踪的驱动方法进行钻进试验。固定驱动频率的方法是在谐振频率识别算法识别初始状态的谐振频率之后在工作过程中保持驱动频率值不变,钻进试验中钻进对象为硬砂岩,其抗压强度为80～100 MPa,钻压力为5 N,超声波钻钻杆材料为钨钢,钻杆直径为3 mm。

两种驱动方法在工作过程中换能器的阻抗变化曲线和电流变化曲线如图21、22所示。当固定驱动频率时,工作过程中随着换能器状态的变化,换能器阻抗上升、两端电流下降,导致驱动效果变差;频率跟踪的控制方法可以使换能器阻抗保持在低点,降低电流衰减的幅度,保持良好的驱动状态。