本文仅供学习使用，并非商业用途，全文是针对哈尔滨工业大学刘文之的论文《移动机器人的路径规划与定位技术研究》进行提炼与学习。论文来源中国知网，引用格式如下： [1]刘文之. 基于激光雷达的SLAM和路径规划算法研究与实现[D].哈尔滨工业大学,2018.
相关坐标系转换原理已经在前一篇文章写完了，直接上转换方程。
这里他的运动模型选择的是基于里程计的运动模型，还有一种基于速度的运动模型，其实都差不多，整体思想都一样。里程计是通过计算一定时间内光电编码器输出脉冲数来估计机器人运动位移的装置，主要是使用光电码盘。根据光电码盘计算出此时轮子的速度，然后通过已知的轮子半径来获得单位时间 每个轮子 的位移增量。
高等数学可知单位时间位移增量就是速度，对速度在一定时间上进行积分就得到这一段时间所走过的路程。
根据上图，我们可以求出来机器人航向角角速度、圆弧运动半径和机器人角度变化量，由此可以解的机器人在当前时刻的位姿。
实际上也是有误差，所以单独依靠里程计会与实际结果产生较大误差，所以必须引入其他的外部传感器对外部环境的观测来修正这些误差，从而提高定位精度。
首先肯定需要将激光雷达所测得的端点坐标从极坐标、机器人坐标中转换到世界坐标中。
这张略过，暂时不需要看这个
路径规划算法介绍：
因为该算法会产生大量的无用临时途径，简单说就是很慢，所以有了其他算法。
了解两种代价之后，对于每一个方块我们采用预估代价与当前路径代价相加的方法，这样可以表示每一个路径点距离终点的距离。在BFS搜索过程的基础上，优先挑选总代价最低的那个路径进行搜索，就可以少走不少弯路。（算法讲解 ）
在局部路径规划算法之中，我们选用DWA算法（dynamic window approach），又叫动态窗口法。动态窗口法主要是在速度(v, w)空间中采样多组速度，并模拟机器人在这些速度下一定时间内的轨迹。在得到多组轨迹后，对这些轨迹进行评价，选取最优的轨迹所对应的速度来驱动机器人运动。 state sampling就是按照之前给出的全局路径规划，无论是Dijkstra还是A* 都可以方便的得到state sampling，DWA算法所需要提前建立的action sampling有两种：
但是无论是什么情况，上述所做的工作就是把机器人的位移转化到世界坐标中来，而不是机器人坐标系。速度采样结束之后，只需要对小车的轨迹进行评判，就可以得到最优解了。下面介绍速度采样的办法。
对速度进行采样一般有以下三个限制：
当确定了速度范围之后，就需要根据速度分辨率来对小车速度离散化，在每一时刻将小车在不同直线速度角速度组合下所即将要行驶的距离都可视化出来。
其中每一条轨迹都是很多小直线连接起来的。
需要用评价函数来对上述轨迹进行选择，选择最适合的轨迹
最后为了让三个参数在评价函数里所发挥的作用均等，我们使用归一化处理来计算权重。
算法流程整体如下：
只能在学校里下载的……有邮箱吗？发给你~
工程测量技术论文
测量也是一项精确的工作，通过测量学的学习和实习，在我的脑海中形成了一个基本的测量学的轮廓。如下是我给大家整理的工程测量技术论文，希望对大家有所作用。
我国工程测量科技进步很大，发展很快，取得了显著成绩；但是发展还很不平衡，尚跟不上国民经济建设发展和社会进步的需要。摆在我们面前的任务是：大力促进工程测量技术方法与手段的更新换代，积极推动新技术的推广与应用，充分利用控制测量技术、地形图测绘技术、全站仪野外数字测图、摄影测量技术、高分辨率遥感技术等等，把传统的手工测量向电子化、数字化、自动化方向发展。
一、全站仪野外数字测图
全站仪大比例尺数字测图实现了从野外数据采集、处理到绘图过程的自动化和一体化。国内已研制和开发了许多各具特色的大比例尺野外成图软件，比较有代表性的包括清华山维公司的EPSW系统、南方测绘公司的CASS系统、广州开思测绘软件有限公司的SCSG系统。这些系统已在国内生产单位中得到比较广泛的应用。论文参考网。
近年来测绘界提出的“高端全站仪”，要求它不仅能适用于各种测量工作，而且还能用作“单人全站仪”，即只需一人便可进行测图作业，而且在观测点处作业。在这种情况下，为获得高质量的观测成果，对仪器就要提出新的要求。
二、摄影测量技术的发展及其在大比例尺地形图中的应用
当测绘的面积较大或测区条件困难时，使用摄影测量技术包(括航空摄影测量和地面摄影测量进)行地形测绘是一种常用的方法。最近若干年来，摄影测量技术有了两个重大突破，第一是数字摄影测量技术趋于成熟并实际投入应用；第二是GPS的出现使得摄影测量的外业控制变得简单。它们都使得摄影测量方法的经济性和效率大大提高，竞争力和生命力进一步加强。
数字摄影测量也称为软拷贝摄影测量，它从根本上改变了摄影测量对价格昂贵、光机结构复杂的专门测图仪器的依赖，是摄影测量领域的一次革命。论文参考网。基于微机的数字摄影测量系统目前可以高效率、高质量地完成自动定向、空中三角测量、自动数字地面模型生成、自动正射影像图制作和交互式数字测图以及三维景观模型采集等一系列作业，精度与通常的解析测图仪相当。虽然现在的系统尚存在不少缺陷，但数字摄影测量已成为摄影测量的技术主流。
三、高分辨率遥感技术在大比例尺测图中的应用
遥感技术在资源与环境、灾害监测、小比例尺制图等领域均有成功的应用。但由于遥感图像的分辨率较低，难以用于大比例尺制图。近年来，由于新型高分辨率卫星遥感图片的出现，为城市或区域大比例尺制图提供了一种新的数据源。IKONOS卫星于1999年9月24日发射成功，是世界上第一颗提供高分辨率卫星影像的商业遥感卫星。可以提供地面分辨率达1m的IKONOS数字图像，该图像可以用于制作1∶10000比例尺的数字正射影像图、数字地面模型和数字线划图。QuickBird是Digital Globel公司于2001年10月18日在美国发射成功的高分辨率商业遥感卫星，QuickBird在地面的分辨率为0.61m，能够满足更专业、更广泛应用领域的遥感用户，为用户提供更好、更快的遥感信息源服务。2007年9月18日，Digital Globel公司宣布在加州的范登堡空军基地成功发射了一颗05.m级分辨率的商业卫星W:orldView-1，WorldView-1为当今世界最具敏捷性的一颗商业卫星，这是2007年波音航空公司为Digital－Globel公司继QuickBird后成功发射的第二颗商业卫星，该图像完全满足制作11∶0000比例尺的数字正射影像图、数字地面模型和数字线划图，也可望在15∶000地形图的修测中发挥积极的作用。
四、其它的地形测图技术
其它的地形测图技术主要是指将GPS与其它传感器集成于一定运载工具上而形成的数字测图技术及直接利用GPS测图的技术。主要包括:
1(机)载激光雷达系统。论文参考网。激光雷达技术是近数十年来摄影测量与遥感领域最具革命性的成就之一，是目前最先进的对地摄影测量系统。在DGPS、IMU支持下，激光扫描系统通过激光扫描器和距离传感器，经由微计算机对测量资料进行内部处理，显示或存储、输出距离和角度等资料，并与距离传感器获取的数据相匹配，经过相应软件进行一系列处理来获取被测目标的表面形态和三维坐标数据，从而进行各种量算或建立立体模型。该技术的最初目的主要是获取困难地区的数字高程模型(DEM数)据。在这些困难地区，例如森林，沙滩等，使用常规摄影测量方法费时、费力，很难获取高精度的地面高程模型数据。使用机载激光雷达系统，可以高效、高精度地直接获取地面的数字高程模型数据。
2(水)下测绘系统。该系统是一种移动测绘系统，主要由GPS接收机、自动测深仪、数据采集软件和通讯设备等组成，平面测绘精度取决于GPS的作业方式和接收机的性能，高程精度则与测深仪有关。它们已在大比例尺水下地形测量实践中得到了广泛的应用，国内代表的产品有中海达水下测绘系统、南方水下测绘系统。3(R)TK数字测图技术。随着实时动态差分RTK技术的进一步完善，人们提出了RTK测图的设想，就是将RTK当成全站仪，配置相应的支持软件直接用于测图，该方法在地物稀少、植被覆盖不厚的测区中具有良好的应用前景。
五、结语
GPS已成为建立平面控制网的一种常用手段。可以说，GPS技术的发展和应用是本世纪测绘领域最辉煌的.成就之一。随着差分GPS定位技术的发展与应用，不仅是高等级的首级网和加密网，就连图根点和航空摄影测量像控点的测定也广泛采用了GPS。在许多地形测量项目中，光电测距导线早已成为一种最基本的控制测量方法。特别是当使用全站仪时，可以将低等级的图根控制与细部地形测量同步进行，从而提高总体作业效率。徕卡公司最新推出的全站仪与GPS完美结合，是集成了GPS功能的高性能全站仪(超站仪，)无需控制点、长导线和后方交会等工作，直接使用GPS确定该点的三维坐标，然后就可以使用全站仪进行测图、放样等工作。高程控制测量过去一直沿用几何水准测量的方法，这种方法耗时费力，效率较低。本世纪六七十年代以来，随着电磁波测距技术的发展，产生了电子测距三角高程测量，国内外在这方面均做了大量的理论研究和实验论证工作，目前电子测距三角高程测量已可以代替三、四等水准测量，大部分规范也已采纳了这些成果。电子测距三角高程测量无疑是几何水准测量很好的补充手段。同时，随着GPS在平面控制测量上日益广泛的应用，关于GPS在高程控制测量领域的应用研究也掀起了热潮。大比例尺地形图主要指的是15∶00～1∶10000比例尺的地形图。传统的地形图一般均是指线划图，这里不仅指线划图，而且还包括另一种极具应用潜力的图种:影像图D(EM、DOM、DTM等。)目前，数字地形图包(括数字线划图、数字正射影像图等)已取代传统的模拟地形图，成为地形测量的主要产品。
参考文献
[1] 张冰,王铁生,高丽峰. GPS高程拟合模型在带状区域中的应用[J]人民黄河, 2009,(07) .
[2] 王颖,袁铭,严勇,凡亦文. 苏州市GPS水准拟合方法的研究[J]苏州科技学院学报, 2006,(04) .
[3] 熊小莉,吴迪军. GPS高程拟合模型的精度分析[J]铁道勘察, 2007,(02) .
