Journal of Shandong University(Engineering Science) ›› 2019, Vol. 49 ›› Issue (1): 55-65.doi: 10.6040/j.issn.1672-3961.0.2018.301

• Control Science & Engineering • Previous Articles     Next Articles

Design for autonomous charging system of family companion robot

Fengyu ZHOU(),Fang WAN*(),Jiancheng JIAO,Junjian BIAN   

  1. School of Control Science and Engineering, Shandong University, Jinan 250061, Shandong, China
  • Received:2018-08-15 Online:2019-02-20 Published:2019-03-01
  • Contact: Fang WAN E-mail:zhoufengyu@sdu.edu.cn;wfcola@gmail.com
  • Supported by:
    国家重点研发计划项目(2017YFB1302400);国家自然科学基金项目(617732400);山东省重大科技创新工程项目(2017CXGC0926);山东省重点研发计划(公益类专项)项目(2017GGX30133)

Abstract:

To address the limited battery capacity and discontinuous work ring of the family companion robot, a based autonomous charging and docking system was designed for the family companion robot using ROS. The Calman filtering algorithm is used to fuse the encoder data and IMU data. Meanwhile, the environment 2D grid map was constructed by the laser ranger data combined with the Rao-Blackwellized particle filter SLAM algorithm. The global path planning and the local path planning were carried out with the A* approach and the DWA algorithm to control robot reach the neighborhood of the charging station.The dual priority based infrared navigation and docking algorithm was used to guide the robot to the charging station to accurately docking with the charging station. The experimental results showed that the proposed system effectively solved the problem of limited charging distance compared with the traditional method, and had high docking efficiency, success rate, accuracy and generalization ability. Therefore, the system fully satisfied the charge demand of the family companion robot, which could be widely used to address real-world problems.

Key words: autonomous charging, remote docking, short range docking, SLAM, path planning

CLC Number: 

  • TP273

Fig.1

The overall structure of autonomous charging system"

Fig.2

Framework of hardware of autonomous charging system"

Fig.3

Flow chart of A* algorithm"

Fig.4

Searching velocity vector space using DWA algorithm"

Fig.5

Admissible speed in dynamic window"

Fig.6

The schematic diagram of the infrared signal emission range of a charging station"

Fig.7

The receiving range of the infrared receiverhead of a robot"

Fig.8

Infrared navigation docking schematic"

Table 1

Rough docking algorithm for infrared navigation"

第三红外接收头(IR3) 第四红外接收头(IR4) 执行策略
A1区域信号 A1区域信号 原地左转/原地右转
A1区域信号 A2A3A4区域信号 原地右转
A2A3A4区域信号 A1区域信号 原地左转
A2区域信号 A2区域信号 原地右转
A3区域信号 A3区域信号 原地左转
A2区域信号 A3区域信号 直行后退
A3区域信号 A2区域信号 直行前进
A2区域信号 A4区域信号 右后转
A4区域信号 A3区域信号 左后转
A4区域信号 A2区域信号 左后转(大角度)
A3区域信号 A4区域信号 右后转(大角度)
A4区域信号 A4区域信号 螺旋式搜索/漫游搜索

Table 2

An algorithm for accurate docking ofinfrared navigation"

第一红外接收头(IR1) 第二红外接收头(IR2) 执行策略
A1区域信号 A1区域信号 直行后退
A1区域信号 A2A3A4区域信号 右后转
A2A3A4区域信号 A1区域信号 左后转
A2区域信号 A2区域信号 右后转(角度稍大)
A3区域信号 A3区域信号 左后转(角度稍大)
A2区域信号 A3区域信号 直行后退
A3区域信号 A2区域信号 直行后退
A2区域信号 A4区域信号 右后转
A4区域信号 A3区域信号 左后转
A4区域信号 A2区域信号 直行后退
A3区域信号 A4区域信号 直行后退
A4区域信号 A4区域信号 无效,转入粗略对接

Fig.9

Strategy in non-signal region"

Fig.10

Blind area for autonomous charging and docking"

Fig.11

A schematic diagram of the distribution ofultrasonic sensors in the blind area"

Fig.12

The strategy of independent charging and docking blind area"

Fig.13

Membership function of input and output"

Table 3

Fuzzy control rule table"

序号 输入 输出
LBD BD RBD ppose vi vo ω
1 NEAR FAR FAR LEFT SLOW NORMAL TRL
2 NEAR FAR FAR LEFT NORMAL NORMAL TRL
3 NEAR FAR FAR LEFT FAST SLOW TR
4 NEAR FAR FAR BACK SLOW NORMAL TRL
5 NEAR FAR FAR BACK NORMAL NORMAL TRL
6 NEAR FAR FAR BACK FAST SLOW TR
7 NEAR FAR FAR RIGHT SLOW NORMAL TR
8 NEAR FAR FAR RIGHT NORMAL NORMAL TR
9 NEAR FAR FAR RIGHT FAST SLOW TR

Fig.14

2D maps and real environment of Laboratory"

Fig.15

2D map and real environment in the corridor ofthe corridor"

Fig.16

2D map and real environment in the interior hall"

Fig.17

Remote docking phase of autonomous charging"

Fig.18

Accuracy statistics of remote docking"

Fig.19

Grid division of the experiment area"

Table 4

Statistics of time consuming for robots at different poses"

位姿 时间/s
偏差距离 初始姿态/(°) 1 m 2 m 3 m 4 m 5 m 6 m 7 m
0 5 10 15 20 25 30 35
90 17 9 14 19 23 29 33
同轴 180 39 17 18 23 29 30 42
270 16 10 14 18 24 29 33
0 5 9 13 19 24 29 34
90 16 11 15 19 25 31 40
偏右0.5 m 180 12 16 20 24 29 30 40
270 17 12 14 20 24 31 43
0 25 10 14 18 24 29 34
90 28 13 16 20 25 31 35
偏右1.0 m 180 33 18 23 26 32 35 40
270 27 12 16 21 26 31 33
0 5 9 14 18 23 28 35
90 17 12 17 21 24 32 41
偏左0.5 m 180 10 15 19 24 29 34 40
270 17 12 16 18 25 30 40
0 25 10 14 18 23 28 33
90° 27 12 17 21 25 30 34
偏左1.0 m 180 33 18 23 26 33 35 40
270 28 13 15 20 25 32 40

Fig.20

Accuracy statistics of charge docking"

1 王建元, 郭威, 刘洋, 等. 基于图像识别的移动机器人自动完成充电[J]. 电测与仪表, 2017, 54 (10): 103- 107.
doi: 10.3969/j.issn.1001-1390.2017.10.018
WANG Jianyuan , GUO Wei , LIU Yang , et al. Automatic charging of mobile robot based on image recognition[J]. Electrical Measurement and Instrumentation, 2017, 54 (10): 103- 107.
doi: 10.3969/j.issn.1001-1390.2017.10.018
2 周海波. 基于红外线的智能小车自动导航充电系统的设计[J]. 数字技术与应用, 2014, 2 (2): 168.
ZHOU Haibo . Design of intelligent car′s automatic navigation charging system based on infrared ray[J]. Digital Technology and Application, 2014, 3 (2): 168.
3 崔志恒, 韩红玲. 红外导航自主充电室内移动机器人设计[J]. 实验室研究与探索, 2012, 31 (10): 33- 36.
doi: 10.3969/j.issn.1006-7167.2012.10.010
CUI Zhiheng , HAN Hongling . Design of an auto-recharging mobile robot navigated by infrared ray[J]. Research and Exploration in Laboratory, 2012, 31 (10): 33- 36.
doi: 10.3969/j.issn.1006-7167.2012.10.010
4 NOURBAKHSH I , BOBENAGE J , GRANGE S , et al. An affective mobile robot with a full-time job[J]. Artificial Intelligence, 1999, 114 (1/2): 95- 124.
5 SILVERMAN M C, NIES D, JUNG B, et al. Staying alive: a docking station for autonomous robot recharging[C]//IEEE International Conference on Robotics and Automation. Washington, D.C, USA: IEEE, 2002: 1050-1055.
6 SENANAYAKE H M B , AKINSANMI O , MAZU M B . An experimental autonomous path tracking mobile robot[J]. Advanced Materials Research, 2009, 62-64, 181- 186.
doi: 10.4028/www.scientific.net/AMR.62-64
7 HUANG Y , ZHAO H , GAO L I , et al. Self recharging algorithm for indoor mobile robot[J]. Journal of Jishou University, 2016, 32 (2): 132- 145.
8 朱世强, 刘瑜, 庞作伟, 等. 自主吸尘机器人的研究现状[J]. 机器人, 2004, 26 (6): 569- 574.
doi: 10.3321/j.issn:1002-0446.2004.06.019
ZHU Shiqiang , LIU Yu , PANG Zuowei , et al. Overview of autonomous cleaning robots[J]. Robot, 2004, 26 (6): 569- 574.
doi: 10.3321/j.issn:1002-0446.2004.06.019
9 吴海彬, 朱世强, 马翔. 自主吸尘机器人在非结构环境下的避障与路径规划研究[J]. 机器人, 2000, 22 (7): 627- 630.
WU Haibin , ZHU Shiqiang , MA Xiang . Research on obstacle avoidance and path planning of autonomous vacuum cleaning robot in unstructured environment[J]. Robot, 2000, 22 (7): 627- 630.
10 郝宗波, 洪炳镕. 室内环境下移动机器人自主充电研究[J]. 哈尔滨工业大学学报, 2005, 37 (7): 885- 887.
doi: 10.3321/j.issn:0367-6234.2005.07.007
HAO Zongbo , HONG Bingrong . Research on auto-recharging for mobile robot in indoor environment[J]. Journal of Harbin Institute of Technology, 2005, 37 (7): 885- 887.
doi: 10.3321/j.issn:0367-6234.2005.07.007
11 黎阳生.变电站巡检机器人自主充电装置及对接控制研究[D].重庆:重庆大学, 2013.
LI Yangsheng. Study on auto-recharging device and docking control for substation inspection robot[D]. Chongqing: Chongqing University, 2013.
12 KONOLIGE K, GRISETTI G, KMMERLE R, et al. Efficient sparse pose adjustment for 2nd mapping[C]//International Conference on Intelligent Robots and Systems. Taiwan, China: IEEE, 2010: 22-29.
13 KOHLBRECHER S, STRYK O V, MEYER J, et al. A flexible and scalable SLAM system with full 3D motion estimation[C]//IEEE International Symposium on Safety, Security, and Rescue Robotics. Kyoto, Japan: IEEE, 2011: 155-160.
14 HESS W, KOHLER D, RAPP H, et al. Real-time loop closure in 2D LIDAR SLAM[C]//International Conference on Robotics & Automation. Stockholm, Sweden: IEEE, 2016: 1271-1278.
15 DAVISON A J , REID I D , MOLTON N D , et al. MonoSLAM: real-time single camera SLAM[J]. IEEE Transactions on Pattern Analysis & Machine Intelligence, 2007, (6): 1052- 1067.
16 OLSON E B . Real-time correlative scan matching[J]. Ann Arbor, 2009, 10 (1): 98- 109.
17 未永飞, 杜正春, 姚振强. 中值滤波在激光雷达点云数据预处理中的应用[J]. 激光技术, 2009, 33 (2): 213- 216.
WEI Yongfei , DU Zhengchun , YAO Zhenqiang . Application of median filter in point cloud data pre-processing lidar[J]. Laser Technology, 2009, 33 (2): 213- 216.
18 GRISETTI G , STACHNISS C , BURGARD W . Improved techniques for grid mapping with rao-blackwellized particle filters[J]. IEEE Transactions on Robotics, 2007, 23 (1): 34- 46.
doi: 10.1109/TRO.2006.889486
19 王殿君. 基于改进A*算法的室内移动机器人路径规划[J]. 清华大学学报(自然科学版), 2012, 52 (8): 1085- 1089.
WANG Dianjun . Indoor mobile-robot path planning based on an improved A* algorithm[J]. Journal of Tsinghua University (Science and Technology), 2012, 52 (8): 1085- 1089.
20 朱大奇, 颜明重. 移动机器人路径规划技术综述[J]. 控制与决策, 2010, 25 (7): 961- 967.
ZHU Daqi , YAN Mingzhong . Survey on technology of mobile robot path planning[J]. Control and Decision, 2010, 25 (7): 961- 967.
21 曲道奎, 杜振军, 徐殿国, 等. 移动机器人路径规划方法研究[J]. 机器人, 2008, 30 (2): 97- 101.
doi: 10.3321/j.issn:1002-0446.2008.02.001
QU Daokui , DU Zhenjun , XU Dianguo , et al. Research on path planning for a mobile robot[J]. Robot, 2008, 30 (2): 97- 101.
doi: 10.3321/j.issn:1002-0446.2008.02.001
[1] Jianqing WU,Xiuguang SONG. Review on development of simultaneous localization and mapping technology [J]. Journal of Shandong University(Engineering Science), 2021, 51(5): 16-31.
[2] Hao XIAO,Zhuhua LIAO,Yizhi LIU,Silin LIU,Jianxun LIU. Unmanned vehicle path planning based on deep Q learning in real environment [J]. Journal of Shandong University(Engineering Science), 2021, 51(1): 100-107.
[3] Caihong LI,Chun FANG,Zhiqiang WANG,Bin XIA,Fengying WANG. Complete coverage path planning for mobile robots based on hyperchaotic synchronization control [J]. Journal of Shandong University(Engineering Science), 2019, 49(6): 63-72.
[4] Qiang ZHANG. Motion control system design of multi-joint snake-like manipulator for nuclear environment [J]. Journal of Shandong University(Engineering Science), 2018, 48(6): 122-131.
[5] ZHANG Li, ZHAO Chun-xia*. A new FastSLAM algorithm based on iterated EKF [J]. JOURNAL OF SHANDONG UNIVERSITY (ENGINEERING SCIENCE), 2012, 42(4): 41-47.
[6] YAN Xuan-hui, XIAO Guo-bao*. Path planning of a mobile robot based on fixed-length real number encoding mechanism [J]. JOURNAL OF SHANDONG UNIVERSITY (ENGINEERING SCIENCE), 2012, 42(1): 59-65.
[7] LIU Bin, ZHANG Ren-jin. A path planning method using two-stage particle swarm optimization [J]. JOURNAL OF SHANDONG UNIVERSITY (ENGINEERING SCIENCE), 2012, 42(1): 12-18.
[8] CHEN Ming-zhi1, XU Chun-yao2, CHEN Jian2, YU Lun2. Path planning based on semantic information in virtual environment [J]. JOURNAL OF SHANDONG UNIVERSITY (ENGINEERING SCIENCE), 2011, 41(4): 106-112.
Viewed
Full text


Abstract

Cited

  Shared   
  Discussed   
[1] . [J]. JOURNAL OF SHANDONG UNIVERSITY (ENGINEERING SCIENCE), 2009, 39(2): 108 -112 .
[2] ZHANG Gong-xiao,YANG Rong-hua . Synthesis and characterization of salicylaldehyde methylthiosemicarbazone Schiff base complexes[J]. JOURNAL OF SHANDONG UNIVERSITY (ENGINEERING SCIENCE), 2008, 38(3): 108 -111 .
[3] LUO Yun-hu,XING Li-dong,WANG Qin,LIU Hai-chun,WENG Xiao-guang . Coordination of bidding strategies for two kinds of interruptible load reserve markets on demand side[J]. JOURNAL OF SHANDONG UNIVERSITY (ENGINEERING SCIENCE), 2008, 38(3): 77 -80 .
[4] SUN Weiwei, WANG Yuzhen. Finite gain stabilization of singlemachine infinite bus system subject to saturation[J]. JOURNAL OF SHANDONG UNIVERSITY (ENGINEERING SCIENCE), 2009, 39(1): 69 -76 .
[5] SUN Yu-li,LI De-fa,ZUO Dun-wen,QI mei . [J]. JOURNAL OF SHANDONG UNIVERSITY (ENGINEERING SCIENCE), 2006, 36(6): 19 -23 .
[6] XUE Cheng-qian,DONG Jian-wen,MENG Xian-feng,CHANG Hong,CAO Ning,CHEN Hua-ying,LI Mu-sen . The effect of C/C+HA bonerepairing material to the physiological and biochemical response of the crossed Boer Goat[J]. JOURNAL OF SHANDONG UNIVERSITY (ENGINEERING SCIENCE), 2008, 38(3): 73 -76 .
[7] ZHENG Gui-lan,GUAN Rui-fang,SUI Su,LI Jian-quan,LI Guo-zhong . Study on discrimination effect of reactive and reflective road coating[J]. JOURNAL OF SHANDONG UNIVERSITY (ENGINEERING SCIENCE), 2007, 37(1): 86 -89 .
[8] SUN Zong-yao,LIU Yun-gang . Adaptive output feedback stabilization for a class of second-dimensional uncertain nonlinear systems[J]. JOURNAL OF SHANDONG UNIVERSITY (ENGINEERING SCIENCE), 2007, 37(5): 34 -39 .
[9] SONG Ming-da,WANG Wei-qiang,LI Meng-li,XU Shu-gen . Non-destructive evaluation of multilayer wrapped urea reactors[J]. JOURNAL OF SHANDONG UNIVERSITY (ENGINEERING SCIENCE), 2007, 37(4): 50 -54 .
[10] ZHANG Xiao, LI Shu-Cai, ZHANG Qiang-Song, LIU Qin, ZHANG Ning, LIU Bin. Research in  field tests  of the influence factors of the TSP system signal collection quality[J]. JOURNAL OF SHANDONG UNIVERSITY (ENGINEERING SCIENCE), 2009, 39(4): 25 -29 .