毕业设计（论文）-基于家庭服务机器人的定位方法研究.docVIP

目录 摘 要 1 1 家庭服务机器人系统建模 2 1.1 平台------“旅行家Ⅱ”自主移动机器人 2 1.2 机器人坐标系统建模 3 1.3 运动控制模型 3 1.3.1 圆弧模型 4 1.3.2 直线模型 5 1.4 环境地图模式 6 1.5 传感器观测模型 6 1.6 环境噪声和传感器噪声模型 8 2 基于家庭自然环境特征的局部环境地图建立 9 2.1 LRG-04LX激光传感器 9 2.2 家庭自然环境特征识别 10 2.2.1组成棱角平面的直线提取 10 2.2.2棱角识别与提取 11 3 基于家庭自然环境特征的定位方法研究 13 3.1 SLAM模型描述 13 3.2卡尔曼滤波算法 15 3. 3打一展卡尔曼滤波定位算法 17 3.3.1 EKF算法原理 17 3.3.2 EKF 算法定位模型 19 3.3.3 数据关联分析 20 结束语 21 摘 要 基于家庭服务机器人的定位方法研究 家庭服务机器人是一种能为人类日常家庭生活服务的特种智能机器人。集助老、 护老、做家务、娱乐等多功能于一体的家庭服务机器人越来越受到人们重视，是近几 年机器人领域研究的一个热点。解决家庭环境中服务机器人的定位问题是服务机器人 能顺利完成其它家庭生活任务的基础。本文围绕家庭服务机器人利用家庭自然环境特 征进行定位研究，其主要内容如下： 1、针对家庭服务机器人系统建模和实验环境建模等问题，本文以“旅行家 II”自 主移动机器人系统（本文简称“机器人”）为基础实验平台，建立家庭服务机器人系统 的运动模型和确定家庭服务机器人系统控制输入模型，定义环境特征表示形式，建立 传感器观测模型。分析家庭服务机器人系统建模时产生的不确定性和误差，阐述环境 噪声模型和传感器观测噪声模型，完成实验所需模型的建立，为家庭服务机器人定位 研究奠定基础。 2、研究家庭自然环境特征的提取与表示方法，基于家庭自然环境特征建立家庭环 境特征地图。主要利用家庭服务机器人自身携带的激光传感器探测家庭环境内形状规 则物体的棱角，并将已探测到的规则物体的棱角作为家庭服务机器人在家庭环境内定 位时的自然路标，定义这些自然路标为自然环境特征的特征点，建立环境特征地图。 最后通过“旅行家 II”自主移动机器人系统进行实验，验证了所提出方法的有效性。 3、研究解决家庭服务机器人系统定位问题的理论方法。结合家庭服务机器人 SLAM 模型和家庭自然环境特征提取方法，利用扩展卡尔曼滤波（EKF）算法和无迹 卡尔曼滤波（UKF）算法来预测和估计家庭服务机器人各时刻的位姿状态和自然环境 路标的位置，并更新自然环境特征地图。在理论计算方面，利用 UKF 算法定位的误差 要比 EKF 算法定位的误差小。 关键词： 家庭服务机器人，定位，家庭自然环境特征，扩展卡尔曼滤波 1 家庭服务机器人系统建模 1.1 平台------“旅行家”自主移动机器人 II自主移动机器人系统用的是模块化设计方法，包括底层运动底盘模块、电源及驱动设备模块、传感器模块、计算机模块，，具有高运动精度的直流伺服控制系统和高负载能力，拥有开放式的系统架构，可以扩展其它功能的辅助设备，如激光、红外、视觉和陀螺仪等传感器。 图“旅行家”自主移动机器人系统 标准尺寸 长*宽*高 470*440*440mm 重量 30KG 额定电压 24VDC 工作电流 2A 驱动方式 双轮差动式私服点击直接驱动 电池 24V18Ah动力蓄电池 最大速度 3m/s 最小速度 0.001m/s 最大负载 40KG 工作时间 6小时 爬坡能力 15° 越障能力 3cm高度障碍物 表 “旅行家”自主移动机器人系统基本系能参数1.2 机器人坐标系统建模 主要应用三种坐标系统:全局坐标系统(世界坐标系统)，以 表示；机器人坐标系统，以 表示；激光传感器坐标系统，以 表示。 1.3 运动控制模型 机器人的定位过程是机器人移动时利用采集到的信息进行位姿状态估计的过程，也是确定机器人在全局坐标系统下移动时位置和方向的过程。 机器人在二维的平面环境中移动时，位姿状态可以用一个三维向量 表示在K时刻机器人在全局坐标系下的位置坐标； 表示机器人的前进方向以偏离全局坐标系中 轴所成的夹角，定义夹角 的方向是180°到-180° 。 运动控制模型可用一个离散时间差分方程表示： 其中 表示K时刻机器人的位姿状态； 为已知输入控制量； 为噪声干扰，用以表示机器人移动时传感器的误差漂移、打滑、外界干扰和系统建模误差等未知影响。 里程计传感器模型 机器人运动