CN110221606A - 一种基于测距信号的距离变化率求解及机器人编队方法 - Google Patents

一种基于测距信号的距离变化率求解及机器人编队方法 Download PDF

Info

Publication number
CN110221606A
CN110221606A CN201910417509.9A CN201910417509A CN110221606A CN 110221606 A CN110221606 A CN 110221606A CN 201910417509 A CN201910417509 A CN 201910417509A CN 110221606 A CN110221606 A CN 110221606A
Authority
CN
China
Prior art keywords
range rate
distance
solving
signal
distance measuring
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
CN201910417509.9A
Other languages
English (en)
Other versions
CN110221606B (zh
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.)
Nanjing University of Aeronautics and Astronautics
Original Assignee
Nanjing University of Aeronautics and Astronautics
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 Nanjing University of Aeronautics and Astronautics filed Critical Nanjing University of Aeronautics and Astronautics
Priority to CN201910417509.9A priority Critical patent/CN110221606B/zh
Publication of CN110221606A publication Critical patent/CN110221606A/zh
Application granted granted Critical
Publication of CN110221606B publication Critical patent/CN110221606B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0287—Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Measurement Of Optical Distance (AREA)
  • Manipulator (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

本发明公开了一种基于测距信号的距离变化率求解及机器人编队方法，设计一种用于需要测量距离变化率但只能提供距离信息的工程应用场景之中。本发明设计了利用距离、距离求解值和距离变化率求解值得到距离变化率的方法，并对该方法的收敛性进行了分析。本发明还将求解方法运用到一个地面机器人编队问题的实例中以验证合理性。最后将本发明求解方法与已有的求解方法进行对比，同时加入信号扰动，说明本发明求解方法的优越性。

Description

一种基于测距信号的距离变化率求解及机器人编队方法
技术领域
本发明涉及一种基于测距信号的距离变化率求解及机器人编队方法，属于计量技术领域。
背景技术
随着近年来科技水平的不断提高，很多工程领域如机器人自动控制领域需要测量大量的距离、距离变化率、速度、加速度等信息，以此达到精确控制的目的。其中，针对距离变化率的测量是非常重要的。在当前的技术条件限制下，动态的距离变化率信号难以测量或测量值精度不高，并且存在易受噪声干扰的问题。相对而言，利用已经成熟的测距技术手段，如采用电波辐射源与返回点间的往返距离的电波相位迟后或直接与传播时间成正比进行测量，可以得到精度非常高的距离信息，以此求解距离变化率信息是可行的手段。这种求解方法具有良好的快速性、稳定性和精确度，既可以提高距离变化率信号的精度，又可以回避直接测量的难题，降低成本。对于距离变化率的求解方法，主要难点是保证求解方法的收敛性。
发明内容
本发明所要解决的技术问题是：提供一种基于测距信号的距离变化率求解及机器人编队方法，克服了实际工程应用中实际测量或解算的距离变化率信号精度差和易受噪声干扰的问题。
本发明为解决上述技术问题采用以下技术方案：
一种基于测距信号的距离变化率求解方法，包括如下步骤：
利用测距传感器获取距离信号，根据距离信号设计求解距离变化率的微分方程组，所述求解距离变化率的微分方程组为：
其中，s表示距离，表示距离求解量，表示距离求解量的导数，表示距离变化率的求解值，表示距离变化率的求解值的导数，a、b、c均为增益，sgn(·)为符号函数，
作为本发明的一种优选方案，距离变化率求解方法的收敛性分析方法为：
采用李雅普诺夫方法进行收敛性分析，所述李雅普诺夫方法的方程为：
L＝[|x1|sgn(x1),x1,x2]·J·[|x1|sgn(x1),x1,x2]T
其中，s表示距离，表示距离求解量，表示距离变化率，表示距离变化率的求解值，a、b、c均为增益，d>0。
一种基于测距信号的机器人编队方法，包括如下步骤：
首先，利用测距传感器采集距离信号，将距离信号代入求解距离变化率的微分方程组，解算得到距离变化率；然后，将求解的距离变化率和测得的距离信号传入制导模块，由制导模块计算得到编队机器人的控制信号；最后将控制信号输入机器人模块，实现机器人编队。
本发明采用以上技术方案与现有技术相比，具有以下技术效果：
1、本发明提供了一种可用于实际工程中的基于测距信号的距离变化率求解方法。
2、本发明用这种求解方法得到的距离变化率比现有方法更精确、收敛速度更快。
3、本发明这种求解方法对信号噪声具有更好的抗干扰能力。
附图说明
图1是应用本方法求解距离变化率的实际应用模型。
图2是图1实施例中实际距离变化率与本发明求解的距离变化率对比。
图3是图1实施例中实际距离变化率、本发明求解方法以及现有求解方法对比。
图4是图1实施例基础上增加高斯扰动的实际应用模型。
图5是增加高斯噪声前后本发明求解的距离变化率对比。
具体实施方式
下面详细描述本发明的实施方式，所述实施方式的示例在附图中示出。下面通过参考附图描述的实施方式是示例性的，仅用于解释本发明，而不能解释为对本发明的限制。
1、基于测距信号的距离变化率求解方法
根据已知的距离测量信息，设计对距离变化率求解的微分方程组：
其中，a、b、c为增益，sgn(·)为符号函数，s表示距离，表示距离求解量，表示距离求解量的导数，表示距离变化率的求解值，表示距离变化率的求解量的导数。
2、对提出的距离变化率求解方法采用李雅普诺夫方法进行收敛性分析
定义变量由此得到定义函数g(t,x1,x2)，其满足|g(t,x1,x2)|≤μ1|x1|+μ2|x2|，μ1和μ2表示扰动，且满足μ1>0，μ2>0。则式(1)可改写为
定义变量η＝[|x1|sgn(x1),x1,x2]T，提出李雅普诺夫函数
L＝ηTJη (3)
其中且d>0。对式(3)求导，得到
其中
因为|g(t,x1,x2)|≤μ1|x1|+μ2|x2|，进而得到
将式(5)，(6)代入(4)，得到
其中
因为Z1+Z2-Z3-Z4是正定的，所以又因为ηT(Z1-Z3)η≥λmin(Z1-Z3)||η||2，所以λmin(·)表示正定对称矩阵的最小特征值；又因为L≤λmax(J)||η||2，所以λmax(·)表示正定对称矩阵的最大特征值。
综合上述分析，推出
对式(7)两边积分，积分区间为[0,t]，得到
由式(8)可知，在一定时间内，L趋于0。综合分析式(3)、式(8)，根据李雅普诺夫稳定性判别定理可知，当L>0且时，式(2)对应的系统处于平衡状态，此时计算得到参数范围0<a<2.5，c>0，d>0。当L＝0，对应平衡点(x1,x2)＝(0,0)。由此可知式(1)对应的系统也是收敛的，且对应的平衡点
综合1、2中的介绍，本发明中基于距离的距离变化率求解方法是稳定有效的。将该求解方法应用于一个地面机器人编队问题实例中，其MATLAB模型如图1所示。在该实际工程应用场景中，只采集距离信号，将该信号传入解算模块，求得编队制导需要的距离变化率信号；然后，同时将求解的距离变化率和测得的距离信号传入制导模块，由制导模块计算得到编队机器人的控制信号；最后将控制信号输入机器人模块，实现机器人编队。
在该实际应用场景中，一共使用了4台装有测距传感器的可移动机器人平台，每台机器人都配有型号相同的微型计算机以及信号接收装置。4台机器人的初始位置可以在信号接收装置以及距离传感器的有效范围内任意选取。最终编队目标是经过一段时间后，各机器人均匀分布在以某个固定目标为圆心，一定长度为半径的圆上，各机器人之间距离相等，并作圆周运动，在编队过程中，各机器人之间不会相撞。
该过程中本发明的求解算法结果，如图2所示。其中，实际距离变化率由测得的距离信号通过仿真工具中的微分模块得到。
在图1实施例基础上，与现有公开的一种具有代表性的方法(精密测距模拟器距离变化率参数的校准方法，《计量与测试技术》2014年第41卷第5期)进行了对比，结果如图3所示，可以看出本发明中提供的方法较之前出现的方法，其收敛的快速性以及与实际距离变化率对比的准确性都有很大提升。
在图1实例基础上，加入高斯噪声作为扰动，模型结构如图4所示。其仿真结果如图5所示，可以看出本发明中提供的方法对噪声具有抗干扰能力。
以上实施例仅为说明本发明的技术思想，不能以此限定本发明的保护范围，凡是按照本发明提出的技术思想，在技术方案基础上所做的任何改动，均落入本发明保护范围之内。

Claims (3)

1.一种基于测距信号的距离变化率求解方法，其特征在于，包括如下步骤：
利用测距传感器获取距离信号，根据距离信号设计求解距离变化率的微分方程组，所述求解距离变化率的微分方程组为：
其中，s表示距离，表示距离求解量，表示距离求解量的导数，表示距离变化率的求解值，表示距离变化率的求解值的导数，a、b、c均为增益，sgn(·)为符号函数，
2.根据权利要求1所述基于测距信号的距离变化率求解方法，其特征在于，距离变化率求解方法的收敛性分析方法为：
采用李雅普诺夫方法进行收敛性分析，所述李雅普诺夫方法的方程为：
L＝[|x1|sgn(x1),x1,x2]·J·[|x1|sgn(x1),x1,x2]T
其中，s表示距离，表示距离求解量，表示距离变化率，表示距离变化率的求解值，a、b、c均为增益，d>0。
3.一种基于测距信号的机器人编队方法，其特征在于，包括如下步骤：
首先，利用测距传感器采集距离信号，将距离信号代入求解距离变化率的微分方程组，解算得到距离变化率；然后，将求解的距离变化率和测得的距离信号传入制导模块，由制导模块计算得到编队机器人的控制信号；最后将控制信号输入机器人模块，实现机器人编队。
CN201910417509.9A 2019-05-20 2019-05-20 一种基于测距信号的距离变化率求解及机器人编队方法 Active CN110221606B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910417509.9A CN110221606B (zh) 2019-05-20 2019-05-20 一种基于测距信号的距离变化率求解及机器人编队方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910417509.9A CN110221606B (zh) 2019-05-20 2019-05-20 一种基于测距信号的距离变化率求解及机器人编队方法

Publications (2)

Publication Number Publication Date
CN110221606A true CN110221606A (zh) 2019-09-10
CN110221606B CN110221606B (zh) 2021-08-17

Family

ID=67821404

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910417509.9A Active CN110221606B (zh) 2019-05-20 2019-05-20 一种基于测距信号的距离变化率求解及机器人编队方法

Country Status (1)

Country Link
CN (1) CN110221606B (zh)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2809468B2 (ja) * 1989-03-06 1998-10-08 レイセオン・カンパニー スペクトラム拡散信号検出装置
CN104266546A (zh) * 2014-09-22 2015-01-07 哈尔滨工业大学 一种基于视线的有限时间收敛主动防御制导控制方法
CN104943694A (zh) * 2014-03-28 2015-09-30 通用汽车环球科技运作有限责任公司 用于确定和补偿传感器的未对准的系统和方法
CN107422748A (zh) * 2017-06-29 2017-12-01 南京航空航天大学 一种固定翼无人机编队制导装置及协同跟踪制导方法
CN107526073A (zh) * 2017-08-22 2017-12-29 哈尔滨工程大学 一种运动多站无源时差频差联合定位方法
CN108227736A (zh) * 2017-12-18 2018-06-29 南京航空航天大学 一种基于测距信号的固定翼无人机编队跟踪制导方法
CN108646554A (zh) * 2018-05-04 2018-10-12 北京航空航天大学 一种基于指定性能的飞行器快速抗干扰纵向制导方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2809468B2 (ja) * 1989-03-06 1998-10-08 レイセオン・カンパニー スペクトラム拡散信号検出装置
CN104943694A (zh) * 2014-03-28 2015-09-30 通用汽车环球科技运作有限责任公司 用于确定和补偿传感器的未对准的系统和方法
CN104266546A (zh) * 2014-09-22 2015-01-07 哈尔滨工业大学 一种基于视线的有限时间收敛主动防御制导控制方法
CN107422748A (zh) * 2017-06-29 2017-12-01 南京航空航天大学 一种固定翼无人机编队制导装置及协同跟踪制导方法
CN107526073A (zh) * 2017-08-22 2017-12-29 哈尔滨工程大学 一种运动多站无源时差频差联合定位方法
CN108227736A (zh) * 2017-12-18 2018-06-29 南京航空航天大学 一种基于测距信号的固定翼无人机编队跟踪制导方法
CN108646554A (zh) * 2018-05-04 2018-10-12 北京航空航天大学 一种基于指定性能的飞行器快速抗干扰纵向制导方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
杨东春 等: "基于激光测距和惯导的非合作目标远程交会相对导航算法研究", 《上海航天》 *
程翊昕 等: "精密测距模拟器距离变化率参数的校准方法", 《计量与测试技术》 *

Also Published As

Publication number Publication date
CN110221606B (zh) 2021-08-17

Similar Documents

Publication Publication Date Title
CN105740203B (zh) 多传感器无源协同测向定位方法
CN100559123C (zh) 一种mems陀螺仪的差分测量方法
CN102865866B (zh) 基于双星敏感器的卫星姿态确定方法及定姿误差分析方法
CN104807414A (zh) 基于分布式光纤传感技术的地铁隧道沉降变形监测方法
KR101651893B1 (ko) 신경망 회로를 이용한 원자로 노심의 축방향 출력분포 합성방법 및 그 방법이 적용된 노심감시계통
CN103808349A (zh) 矢量传感器的误差校正方法和装置
CN103926569B (zh) 三坐标雷达网基于交叉定位点关联的集中式与分布式压制干扰鉴别方法
CN105205237A (zh) 一种基准弹道动态确定方法
RU2310899C1 (ru) Способ формирования сигнала управления и стабилизации продольно-балансировочного движения летательного аппарата и устройство для его осуществления
CN105373647A (zh) 一种通过地面滑跑试验辨识气动焦点的方法
CN106556877A (zh) 一种地磁通化方法及装置
CN103106332A (zh) 一种测量不确定度的分析方法
CN110221606A (zh) 一种基于测距信号的距离变化率求解及机器人编队方法
CN106406290B (zh) 一种车辆横向动力远程测控系统的故障检测方法
CN104898155A (zh) 一种基于中子平均能量的次临界系统次临界度测量方法
CN103092815A (zh) 校准装置及其对监测装置中的传递函数进行校准的方法
CN111912295A (zh) 一种弹道落点预测系统
CN110221245A (zh) 联合估计目标位置和非视距误差的鲁棒tdoa定位方法
RU2570115C2 (ru) Способ управления зенитной управляемой ракетой средней дальности с активной головкой самонаведения при наведении на групповую сосредоточенную цель
CN110673088B (zh) 混合视距和非视距环境中基于到达时间的目标定位方法
CN104635246A (zh) 卫星导航信号的动态范围检测系统及检测方法
CN105955029B (zh) 一种保鲁棒性的pid控制参数优化方法
CN108050997A (zh) 一种基于容积卡尔曼的光纤陀螺滤波方法
CN104101362B (zh) 基于挠性捷联惯组系统模型的陀螺标度因数在线补偿方法
Komaragiri et al. A sag monitoring device based on a cluster of code based GPS receivers

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