CN1776367A - 高压巡线机器人沿输电线路进行导航的方法 - Google Patents

高压巡线机器人沿输电线路进行导航的方法 Download PDF

Info

Publication number
CN1776367A
CN1776367A CN 200510019930 CN200510019930A CN1776367A CN 1776367 A CN1776367 A CN 1776367A CN 200510019930 CN200510019930 CN 200510019930 CN 200510019930 A CN200510019930 A CN 200510019930A CN 1776367 A CN1776367 A CN 1776367A
Authority
CN
China
Prior art keywords
sensor
conducting wires
electromotive force
robot
voltage conducting
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
CN 200510019930
Other languages
English (en)
Other versions
CN100462681C (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.)
GUANGDONG KEYSTAR INTELLIGENCE ROBOT Co.,Ltd.
Original Assignee
Wuhan University WHU
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 Wuhan University WHU filed Critical Wuhan University WHU
Priority to CNB2005100199302A priority Critical patent/CN100462681C/zh
Publication of CN1776367A publication Critical patent/CN1776367A/zh
Application granted granted Critical
Publication of CN100462681C publication Critical patent/CN100462681C/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)

Abstract

本发明公开了一种高压巡线机器人沿输电线路进行导航的方法,其特征在于:将一系列相同参数的电磁传感器分别布置在机器人的手臂上,各组传感器分别同轴线布置,让机器人的各待调控部位的空间位姿状态能通过各该部位的传感器阵列组相对高压输电导线的距离表征。本发明的优点是:实现简单,结构小巧,成本低廉;可避免强电场、强磁场的干扰,实用性强;控制算法简单,操作方便。如配备相应的机器人设备,可以用来辅助完成高压巡线机器人沿架空高压输电线路进行全自动化的巡检作业。

Description

高压巡线机器人沿输电线路进行导航的方法
技术领域
本发明涉及机器人自动作业领域,尤其是一种高压巡线机器人沿架空高压输电线路自动巡检作业时的导航方法。
背景技术
在架空电力线路巡线机器人领域,已有日本东京电力公司的Sawada等人、美国TRC公司、加拿大魁北克水电研究院(IREQ)的Montambault等人先后开展了巡线机器人的研究工作,但他们研制的巡线机器人工作时一般需要人工辅助,或只能完成两线塔之间电力线路的检查,作业范围小,自治程度低。国内有武汉大学在863基金项目资助下开展了具有行走和越障功能的架空电力线路巡线机器人的研究,并申请了专利CN200410061316.8、CN200410061314.9、CN200320116267.4。
具有行走和越障功能的巡线机器人沿架空电力线路运行,要跨越防震锤、悬垂绝缘子、线夹、杆塔等障碍,因此要求其导航传感器系统具有自主的全局定位能力,提供合适的导航方法成为亟待解决的重要问题。由于巡线机器人工作在野外环境下,其行驶路径高压输电线路周围分布有强电场与强磁场,使其对自动导航传感器的选用十分苛刻,目前使用的主要有视觉传感器、超声传感器、激光测距仪等。视觉导航具有很高的空间和灰度分辨率,其探测的范围广、精度高,能够获取场景中绝大部分信息。缺点是难以从背景中分离出要探测的目标,为了将障碍与背景分开,所需的图像计算量很大,导致系统的实时性能较差。而超声传感器的测算距离与巡线机器人的定位要求不符,也不适宜于野外环境。激光测距仪安装定位复杂,成本昂贵,重量体积庞大,机器人不堪负荷。必须克服上述导航传感器的缺点,寻找新的导航方法突破现有技术的局限。
发明内容
本发明的目的在于针对现有技术中存在的问题提供一种高压巡线机器人沿输电线路进行导航的方法。
为实现本发明所述目的,本发明提供一种高压巡线机器人沿输电线路进行导航的方法,将一系列相同参数的电磁传感器分别布置在机器人的手臂上;各组传感器分别同轴线布置,并设各组轴线分别为lA、lB、lC…;各传感器线圈的两端所产生感应电动势按下式:
ϵ = - dφ dt = - NS cos θ dB dt = - NS cos θ * μ 0 dI 2 πrdt - - - ( 1 )
而定,式中ε为线圈中的感应电动势;φ为通过线圈的磁通量;S为线圈截面积;θ为线圈截面的法线与磁场方向的夹角;N为线圈的匝数;r为偏离导线的距离;μ0为真空磁导率;
根据公式(1),使各组传感器的dI、N、S、θ均相等,即让感应电动势ε仅与距离r有关,亦即,让机器人的各待调控部位的空间位姿状态能通过各该部位的传感器阵列组相对高压输电导线的距离r表征。
而且,在每个机器人手臂上设置三组电磁传感器A、B、C,以组成的传感器阵列组来实现对高压导线位姿的识别;使三组传感器阵列分布时满足以下条件:lA平行于lB,lC垂直于lA、lB所确定的平面且lC与lA、lB的距离相等,各组中所有传感器与高压导线的夹角θ均相等,而且各电磁传感器相隔一定距离。
而且,每组m个传感器在其轴线上确定2m-3个点,这2m-3个点将传感器轴线分成2m-2个区间,通过模拟/数字转换比较各传感器感应电动势值的大小,获取最大电动势εmax、次大电动势εsec所对应的传感器编号,确定高压导线投影到传感器轴线上的区域。
而且,导航算法中,设εAmax、εBmax、εCmax分别表示A、B、C组传感器感应电动势的最大值,εAsec、εBsec、εCsec分别表示A、B、C组传感器感应电动势的次大值),导航计算的步骤如下,
a.通过调整使得|εAmaxBmax|<临界值,则此时高压导线与lA、lB距离相等,即高压导线近似平行于lA、lB所确定的平面。
b.求取εAmax、εAsec、εBmax、εBsec对应的传感器编号,确定高压导线投影到传感器轴线lA、lB上的区域,则此两区域间连线范围即为高压导线投影到手臂平面时的区域范围。
c.求取εCmax、εCsec对应的传感器编号,确定高压导线投影到传感器轴线lC上的区域。则此时传感器所在空间区域范围已唯一确定。
为了解决现有技术的难题,本发明采用电磁传感器为高压巡线机器人沿输电线路的相线进行导航,在机器人手臂上设置电磁传感器阵列,根据电磁传感器阵列中的电磁传感器布置划分若干组位置区间,采集电磁传感器阵列的感应信息,按照感应结果和区间划分确定高压导线所在区域,判断其相对于机器人的空间位姿。传感器结构小巧、重量轻、便于安装,软件处理方便,造价低廉。通过布置电磁传感器阵列而划分区间感应高压导线所在位置,简便可靠,利用巧妙的电磁传感器设置,更是提高了效率和精度。本方法实施简单,可避免强电场、强磁场的干扰,实用性强。
附图说明
图1是本发明工作原理示意图;
图2是本发明实施例的电磁传感器测头示意图;
图3A和图3B是本发明实施例的电磁传感器分布示意图;
图4是本发明具体实施例的区间划分示意图;
图5是本发明具体实施例的信号调理电路图。
具体实施方式
参见图1,在机器人手臂上设置电磁传感器阵列,根据电磁传感器阵列中的电磁传感器布置划分若干组位置区间,采集电磁传感器阵列的感应信息,按照感应结果和区间划分确定高压导线所在区域,判断其相对于机器人手臂的空间位姿。得出高压导线相对于机器人手臂的空间位姿,通过机器人自身姿态参数的转换,即可唯一确定机器人各部件相对于高压导线的空间位姿,从而进行导航。架空电力线路巡线机器人的导航系统除电磁传感器外,还应当配设多路转换开关、信号调理电路、模拟/数字(AD)转换电路、控制器等部分,由于集成电路和可编程芯片技术已应用得相当成熟以及广泛,本发明不予赘述,仅提供实施例的电路简略说明以供参考:参见图5,由于电磁传感器线圈回路两端产生的感应电动势信号比较微弱,必须经过放大增大其幅值,选用LM324作为运放芯片,通过可调电阻R3在1~500范围内调节放大倍数;为减少电磁干扰,对信号进行带通滤波,采用二阶压控电压源带通滤波电路,通过C1与R1组成的低通滤波和C2与R2组成的高通滤波级联,使得中心频率f0=50Hz,带宽B=10Hz;最后用两个稳压二极管D1、D2将信号电压限制在AD采样范围内。选用AD574AJD作为AD转换芯片。AD转换后得到的是正弦信号,然后提取其峰值。控制器可采用PC104、89S51单片机等。电磁传感器的感应结果经多路转换开关、信号调理电路和AD转换电路处理成数字信息,控制器根据数字信息进行导航计算,得到机器人的空间位姿后通过驱动器驱动电机,指挥机械本体动作。运动过程中电磁传感器监控机体与环境的位姿关系,反馈到控制器,进而调整运动轨迹,架空电力线路巡线机器人的电磁导航系统得以实现。
参见图2,电磁传感器的测头为具有软磁磁芯的密绕电感线圈,磁芯可以采用铁、硅钢片、坡莫合金等软磁材料,本发明实施例采用普通的具有铁芯的密绕电感线圈L。
参见图3A、3B,为了感应机器人手臂的空间位置,将一系列相同参数的电磁传感器分别布置在机器人的手臂上;各组传感器分别同轴线布置,并设各组轴线分别为lA、lB、lC…。根据比奥-沙伐定律和法拉第电磁感应定律,把一个截面积为S,N匝的线圈(线圈截面的法线与磁场方向的夹角为φ)置于无限长的通有交变电流的导线旁边,则线圈回路的两端将产生感应电动势按下式:
ϵ = - dφ dt = - NS cos θ dB dt = - NS cos θ * μ 0 dI 2 πrdt - - - ( 1 )
式中ε为线圈中的感应电动势,单位为V;φ为通过线圈的磁通量,单位为Wb;S为线圈截面积,单位为m2;θ为线圈截面的法线与磁场方向的夹角,单位为rad;N为线圈的匝数;r为偏离导线的距离,单位为m;μ0为真空磁导率,取μ0=4π×10-7,单位为N/A2
根据公式(1),电磁传感器感应电动势ε与电流的变化率dI、线圈的匝数N、线圈的截面积S、线圈与导线的夹角θ以及线圈与导线的距离r有关。为了简化计算ε与r的关系,本发明人采用“相对值检测”思路,即设计一组传感器,使其dI、N、S、θ均相等,则ε仅与r有关,亦即,让机器人的各待调控部位的空间位姿状态能通过各该部位的传感器阵列组相对高压输电导线的距离r表征。也就是说在这组传感器中,ε值最大的传感器距离高压输电导线最近。用这种相对值检测方法,设计合理的传感器阵列组,即可以确定高压输电导线的位姿状态。
本发明实施例在每个机器人手臂上设计了A、B、C三组电磁传感器,组成电磁传感器阵列组,来实现对高压导线位姿的识别。各组采用的电磁传感器个数计为m,各组m值可以不一样,为后续处理方便最好A、B组取相同值。具体实施时,m值通常在3~15,取值与传感器尺寸、机构尺寸和检测精度有关。其中,各组电磁传感器的测头完全相同,以保证具有相同的N、S,实际上整个电磁传感器阵列采用相同的传感器即可方便的实现;每组电磁传感器测头的中心轴共线(设其轴线分别为lA、lB、lC),以此保证各组中所有传感器测头与高压导线的夹角相等。由于高压导线电流变化率dI对所有传感器均相同,则每组传感器符合相对值检测条件。当然不使一组电磁传感器的dI、N、S、θ均相等,而计算r,理论上可以实现,但必然更为繁琐,“相对值检测”是一种优选方案。
三组电磁传感器分布时满足以下条件:lA平行于lB,lC垂直于lA、lB所确定的平面且lC与lA、lB的距离相等。这种布置是为了构成便于计算时参照的一种立体坐标系,以便根据高压导线到各组电磁传感器的投影唯一确定高压导线所在区域,判断其相对于机器人的空间位姿。本发明实施例将A、B组分布于机器人手臂的两侧,C组垂直于手臂方向布置(沿手爪方向),实施时还可以交换平面,A、B组垂直于手臂方向。
为了防止影响通过相邻电磁传感器的磁通量,将每两传感器测头间相互隔开一定距离。一组电磁传感器中采用相同数值设置两传感器测头之间的间隔距离,该数值在1mm~20mm之间。不同组的间隔距离可以不同。
本发明的导航原理建立在“相对值检测”原理及上述阵列排布方法的基础上,每组传感器中距离高压导线越近的感应电动势越大。以本发明实施例中的A组传感器为例,由m个电磁传感器A1~Am组成,假设其中An号传感器感应电动势为εn,A组中感应电动势最大值为εAmax,次大值为εAsec,则:
①、若εn=εAmax且εn-1=εn+1=εAsec,则表明高压导线距离An传感器最近且An与An-1、An+1距离相等,即高压导线在lA上的投影为An传感器的中点处,记为αn
②、若εn=εn+1=εAmax,则表明高压导线距离An、An+1传感器最近且距离相等,即在αn、an+1连线中点处,记为αn(n+1)
③、若εn=εAmax、εt=εAsec,则表明高压导线在An与At传感器之间区域靠近An侧,即轴线lA上(αn,αnt)区间,记为Ant
根据以上规则,每组m个电磁传感器可确定2m-3个点,这2m-3个点将电磁传感器轴线分成2m-2个区间,其中m的取值根据具体的传感器尺寸、机构尺寸和需要的检测精度而数目不同。参见图4,本发明实施例中A组m个传感器确定a12、a2、a23、…a(m-1)m这2m-3个点,将轴线lA分为A12、A21、A23、…A(m-1)m这2m-2个区间;B组m个传感器确定b12、b2、b23、…b(m-1)m这2m-3个点,将轴线lB分为B12、B21、B23、…B(m-1)m这2m-2个区间;C组同样设置。通过模拟/数字(AD)转换比较各传感器感应电动势值的大小,获取最大感应电动势εmax、次大感应电动势εsec所对应的传感器编号,即可确定高压导线投影到传感器轴线上的区域。
为了通过电磁传感器确定高压导线相对于机器人手臂的空间位姿,还要进行以下导航运算处理(设εAmax、εBmax、εCmax分别表示A、B、C组传感器感应电动势的最大值,εAsec、εBsec、εCsec分别表示A、B、C组传感器感应电动势的次大值):
①、通过调整使得|εAmaxBmax|<临界值,则此时高压导线与lA、lB距离相等,即高压导线近似平行于lA、lB所确定的平面。采用临界值是一种容差方法,即当εAmax与εBmax的差值小于临界值时我们就认为它们近似相等了。临界值的选取与控制精度有关,当控制精度要求高时临界值选取得小,控制精度要求低时临界值选取得大,一般情况下为小于0.2的较小数值。
②、求取εAmax、εAsec、εBmax、εBsec对应的传感器编号,确定高压导线投影到传感器轴线lA、lB上的区域,则此两区域间连线范围即为高压导线投影到手臂平面时的区域范围。
③、求取εCmax、εCsec对应的传感器编号,确定高压导线投影到传感器轴线lC上的区域。则此时电磁传感器所在空间区域范围已唯一确定。
显然,本发明提供的方法可以为专利CN200410061316.8中公开的具有行走和越障功能的巡线机器人提供优秀的导航功能,该机器人有两个手臂(原文称为“小臂”),因此电磁传感器阵列也应当备有两套,以实现不同手臂过障时为机器人提供准确的导航。同时,这种方法也适用于其他种类的巡线机器人,无论手臂的数量,无论是否具有先进地行走和越障功能。

Claims (4)

1.一种高压巡线机器人沿输电线路进行导航的方法,其特征是:
1.1将一系列相同参数的电磁传感器分别布置在机器人的手臂上;
1.2各组传感器分别同轴线布置,并设各组轴线分别为lA、lB、lC…;
1.3各传感器线圈的两端所产生感应电动势按下式:
ϵ = - dφ dt = - NS cos θ dB dt = - NS cos θ * μ 0 dI 2 πrdt - - - ( 1 )
而定,式中ε为线圈中的感应电动势;φ为通过线圈的磁通量;S为线圈截面积;θ为线圈截面的法线与磁场方向的夹角;N为线圈的匝数;r为偏离导线的距离;μ0为真空磁导率;
1.4根据公式(1),使各组传感器的dI、N、S、θ均相等,即让感应电动势ε仅与距离r有关,亦即,让机器人的各待调控部位的空间位姿状态能通过各该部位的传感器阵列组相对高压输电导线的距离r表征。
2.根据权利要求1所述的高压巡线机器人沿输电线路进行导航的方法,其特征是:
1.1.1在每个机器人手臂上设置三组电磁传感器A、B、C,以组成的传感器阵列组来实现对高压导线位姿的识别;
1.1.1.2使三组传感器阵列分布时满足以下条件:lA平行于lB,lC垂直于lA、lB所确定的平面且lC与lA、lB的距离相等,各组中所有传感器与高压导线的夹角θ均相等,而且各电磁传感器相隔一定距离。
3.根据权利要求1或2所述的高压巡线机器人沿输电线路进行导航的方法,其特征是:
每组m个传感器在其轴线上确定2m-3个点,这2m-3个点将传感器轴线分成2m-2个区间,通过模拟/数字转换比较各传感器感应电动势值的大小,获取最大电动势εmax、次大电动势εsec所对应的传感器编号,确定高压导线投影到传感器轴线上的区域。
4.根据权利要求3所述的高压巡线机器人沿输电线路进行导航的方法,其特征是:在导航算法中,设εAmax、εBmax、εCmax分别表示A、B、C组传感器感应电动势的最大值,εAsec、εBsec、εCsec分别表示A、B、C组传感器感应电动势的次大值,导航计算的步骤如下:
a.通过调整使得|εAmaxBmax|<临界值,则此时高压导线与lA、lB距离相等,即高压导线近似平行于lA、lB所确定的平面。
b.求取εAmax、εAsec、εBmax、εBsec对应的传感器编号,确定高压导线投影到传感器轴线lA、lB上的区域,则此两区域间连线范围即为高压导线投影到手臂平面时的区域范围。
c.求取εCmax、εCsec对应的传感器编号,确定高压导线投影到传感器轴线lC上的区域。则此时传感器所在空间区域范围已唯一确定。
CNB2005100199302A 2005-12-01 2005-12-01 高压巡线机器人沿输电线路进行导航的方法 Active CN100462681C (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CNB2005100199302A CN100462681C (zh) 2005-12-01 2005-12-01 高压巡线机器人沿输电线路进行导航的方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CNB2005100199302A CN100462681C (zh) 2005-12-01 2005-12-01 高压巡线机器人沿输电线路进行导航的方法

Publications (2)

Publication Number Publication Date
CN1776367A true CN1776367A (zh) 2006-05-24
CN100462681C CN100462681C (zh) 2009-02-18

Family

ID=36766007

Family Applications (1)

Application Number Title Priority Date Filing Date
CNB2005100199302A Active CN100462681C (zh) 2005-12-01 2005-12-01 高压巡线机器人沿输电线路进行导航的方法

Country Status (1)

Country Link
CN (1) CN100462681C (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102116625B (zh) * 2009-12-31 2013-01-23 武汉大学 巡线机器人gis-gps导航方法
CN105809406A (zh) * 2016-04-24 2016-07-27 羊丁 一种新型计量仪表智能周转系统
CN106493734A (zh) * 2016-10-25 2017-03-15 云南电网有限责任公司电力科学研究院 一种电力机器人的控制系统

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN100379529C (zh) * 2004-12-10 2008-04-09 武汉大学 一种沿架空高压输电线路行驶的机器人
CN100452614C (zh) * 2004-12-10 2009-01-14 武汉大学 用于架空高压输电导线的感应取电装置

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102116625B (zh) * 2009-12-31 2013-01-23 武汉大学 巡线机器人gis-gps导航方法
CN105809406A (zh) * 2016-04-24 2016-07-27 羊丁 一种新型计量仪表智能周转系统
CN106493734A (zh) * 2016-10-25 2017-03-15 云南电网有限责任公司电力科学研究院 一种电力机器人的控制系统
CN106493734B (zh) * 2016-10-25 2018-12-07 云南电网有限责任公司电力科学研究院 一种电力机器人的控制系统

Also Published As

Publication number Publication date
CN100462681C (zh) 2009-02-18

Similar Documents

Publication Publication Date Title
CN102844722B (zh) 利用多个信号以一距离跟随引线的机器人园艺工具
Guo et al. A mobile robot for inspection of substation equipments
CA3121029C (en) Device and method for path planning for a mover of a drive device
CN107611849A (zh) 一种自走式输电线缆巡检机器人
KR101060988B1 (ko) 지그비의 수신신호세기를 이용한 지능형 이동로봇의 이동 대상물 추적 제어 장치 및 그 방법
CN207442545U (zh) 一种对准引导装置以及能进行对准引导的感应充电系统
CN109412280B (zh) 基于预激励磁场的无线电能传输绕组位置辨识装置及方法
CN100462681C (zh) 高压巡线机器人沿输电线路进行导航的方法
CN108995743A (zh) 导航车及导航方法
CN115508912A (zh) 无线充电辅助校准测试装置及测试方法
US3956618A (en) Mechanical-electrical transducer
CN106643382B (zh) 一种相对全位姿检测装置及其应用
CN208842514U (zh) 导航车
JPH10105235A (ja) 移動体の連続位置検出・制御装置
CN1139201A (zh) 引导无人驾驶车辆的方法和设备
CN110707893B (zh) 智能控制系统
Luo et al. An indoor autonomous guided vehicle based on electromagnetic tracking and positioning ibeacon
GB1083103A (en) Improvements in installations for controlling the path with respect to the ground of aircraft
CN110146926B (zh) 一种检测接地网拓扑结构的自动测量无人车及测量方法
CN208224779U (zh) 一种多点交通设施运动轨迹控制装置
Im et al. Development of steering control system for autonomous vehicle using array magnetic sensors
JPS6247241B2 (zh)
JPS609850Y2 (ja) 走行体の位置ずれ測定装置
CN206077080U (zh) 一种机器人的无线充电装置
JPH0578043B2 (zh)

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20210609

Address after: Unit 104 on the first floor and unit 201 on the second floor of keying International Industrial Park Phase I plant, No.7 Xinkai Road, Wusha community, Daliang street, Shunde District, Foshan City, Guangdong Province

Patentee after: GUANGDONG KEYSTAR INTELLIGENCE ROBOT Co.,Ltd.

Address before: 430072 Hubei city of Wuhan province Wuchang Luojiashan

Patentee before: WUHAN University