第六届江苏省大学生机械创新设计大赛项目技术报告参赛学校: 江苏科技大学 作品名称: 可远程视频传输的全方位排障机器人 参赛项目: 机械设计创新大赛 领队老师: 唐炜、顾金凤 研制人员: 张玮文、顾宪成、聂俊杰、高志远 作品名称可远程视频传输的全方位排障机器人选手基本情况本项目组成员共4人，目前均为江苏科技大学机械工程学院在校学生。具体情况如下：参赛成员风采聂俊杰（学号1240202315）：男，机械设计制造及其自动化专业大四学生。项目组负责人，全面组织协调项目总体方案及其实施过程，熟练掌握机械结构数字化建模的相关技能，重点负责本项目虚拟样机的三维建模及运动仿真。张玮文（学号1340206131）：男，机械电子工程专业大三学生。擅长单片机应用技术及控制系统的开发与调试，重点负责本项目单片机控制系统硬/软件的自主设计研发，样机联机调试。顾宪成（学号1340206209）：男，机械电子工程专业大三学生。擅长运动学建模及软件编程，重点负责本项目运动学模型的建立，控制程序的编写及完善。高志远（学号1340206207）：男，机械电子工程专业大三学生。熟练掌握机电系统调试和维护工作，重点负责本项目样机加工/装配及相关实验平台搭建。1、作品介绍1.1研究背景从世界范围来看，工业4.0概念引领了全世界制造业的发展方向，其强调的工业化和智能化融合发展道路，而“中国制造2025”的十大领域中强调重点发展新一代信息技术、高档数控机床和机器人。经过几十年的发展，如今机器人发展的特点可概括为：横向上，应用面越来越宽，由95%的工业应用扩展到更多领域的非工业应用；像做手术、采摘水果、剪枝、巷道掘进、侦查、排雷、探索，还有空间机器人、潜海机器人。纵向上，机器人的种类会越来越多，像进入人体的微型机器人，已成为一个新方向，可以小到像一个米粒般大小；机器人智能化得到加强，机器人会更加聪明。因此，智能化、信息化是机器人发展的一大方向。本项目源于现实需要，由于其小体积以及全向性，尤其适合在一些狭小空间以及特殊场景的应用，如在一些危险场地的探测或者特殊路面的排查等。通过车身上搭载摄像头完成对周围环境的实时监测，并用无线WIFI传输上传到服务器上，供监测人员了解工作的环境，并结合地盘上的机械臂通过其装卸功能即可实现对于作业场地一些实体的信息采集也可以在一些狭小空间做到物质的远程运输，从而集成了运输与探索于一体的功能。另外可通过在车身上增加各类传感器拓展其外围功能，如避障等。 1.2结构说明该机器人由全向移动底盘、车载机械手和手机操控终端三大部分组成。其中，移动底盘采用四个Mecanum轮独立驱动的形式，以实现平面内的全方位运动；六自由度机械手完成对地面障碍物的移位或搬运等功能；车载摄像头实现对周围环境的图像采集并通过无线WIFI传输到操控手机上，从而确保在用户不进入危险现场的前提下，可通过远程视频操控的方式实现机器人排障的功能。 全向底盘是用来承载机械手的部分，主要负责全向移动部分的工作。整个底盘的制作材料为铝板，四个轮子安装在四个悬臂上，悬臂根部与底盘顶端之间安装有减震器，这样就组成了悬架结构，确保了全向底盘在不平的路面上仍然能四个轮子同时着地，使得小车运行更加平稳，路径更加精确。小车的底部与顶部之间的空间用来安放控制系统的控制板以及走线。图1就是全向底盘机械结构的三维造型图。图1 全向底盘机械手是由六个舵机进行驱动的，六个舵机分别安装在六个关节部位。如图2，由腰部到爪子部位六个舵机分别编号为号。在这六个舵机当中最为重要的是三个舵机，这三个舵机协同控制使得机械手的爪子部分能够运动到当前平面内可触及区域的任意位置，号舵机是控制机械手左右旋转的，因此控制到号舵机就可以实现机械手在近似球体空间内进行运动。号舵机控制爪子部分的旋转，号舵机控制爪子部分的张合。图2 机械手1.3技术参数可远程视频传输的全方位排障机器人具体技术指标如下：1）该机器人小车能在狭小作业空间内实现灵活移动，可完成前后移动、横向侧移和原地旋转等基本运动及其复杂的任意组合运动形式，同时机械手完成物品的夹持、装卸和移位。2）该机器人通过摄像头可以对周围环境实时的监控和采集，该摄像头模块型号是Robot eyes，分辨率为720p、输出的格式MJGEP、内置麦克风且为USB接口。3）无线WIFI模块，将采集到到信息实时传输给远程手机上，该模块型号是Robot-Link V5.0 MT采用双天线传输速度可达到300mbps，驱动摄像头默认30fps；室外传输的距离可达30米，室内20米，保证传输视频的清晰度和流畅度。4）小车自重不超过20KG，最高直线速度20cm/s，控制精度小于5%，可距障碍物15cm时停车。1.4工作原理可远程视频传输的全方位排障机器人的机械结构分为全向底盘与机械手两部分，控制系统也分为上述的两个部分。两块STM32单片机分别为两个部分的主控芯片，两个控制系统之间由WIFI协调控制，手机作为命令的发射端。两块单片机通过对WIFI所发送的命令判断来做出下一步的动作。两块单片相对于WIFI而言是处于并联的关系，此外在整个过程中机器人通过摄像头可以对周围环境实时的监控和采集，并将视频传输到手机上供操作人员了解周围环境从而下达进一步指令。最终两块单片机与视频相结合共同控制了排障机器人的整体运动。图3所示就是规划的控制总体方案框图。图3 控制系统总体方案1.4.1全向底盘本项目全向底盘采用Mecanum轮作为全向轮，Mecanum轮具有承重能力大、与地面摩擦力大、不容易打滑、运动平滑等优点。应用Mecanum轮后车轮的位置相对固定，不需要其它独立的转向机构，通过各个轮子间的相互配合即可实现全向移动。所谓全向移动，就是说机器人小车能在不改变自身位姿的情况下实现任意方向、任意回转曲率半径的平面运动，其基本运动形式包括前后移动、横向侧移和原地旋转（零回转半径）。因为逆雅可比矩阵的秩等于3是实现全向运动的必要条件，所以全向底盘采用的是图4所示的轮子布局方案。本课题设计的全向移动平台为四轮矩形分布的，四个轮子的中心轴都平行于y轴，全向移动平台的速度为，四个轮子的角速度为，L为移动平台的长度的一半，为宽度的一半。由此可得Mecanum轮全向移动平台的正运动学方程： (3.1)Mecanum轮全向移动平台的逆运动学方程为： (3.2)根据式（3.1）可知，给轮子不同的角速度并相互组合就可以实现移动平台在一个平面内的三自由度全方位移动。例如：当时，移动平台的速度为，移动平台将进行前后移动；当时，移动平台的速度为，移动平台将进行左右移动；当时，移动平台的速度为，移动平台将进行原地回转运动。如果已知移动平台的速度，那么就可以根据式（3.2）求出每个轮子的角速度。 图4 全向底盘轮子布局具有代表性的几个方向运动轮子的旋向如图5所示。图5 轮子旋向与底盘行走方向以原地旋转为例，左侧两轮旋转矢量方向向左（轮子向前转），转速大小相等，辊子轴向力与滚动摩擦力方向如图所示，这些力的合力是绕机器人本体中心周的逆时针力偶，故表现为逆时针转动。 1.4.2六自由度机械手本项目机械手预计执行三个动作，分别为下降、抓取物体、放置物体并回原位这三个动作。要实现上述的三个动作就必须预先求出六个舵机执行动作分别需要变化的角度。抓取物体和放置物体通过最后一个舵机即可控制。关键问题是上升和下降过程中相关三个舵机旋转角度的配合。机械爪子的驱动原理主要是一个齿轮与舵机转轴固定，当舵机旋转时带动该齿轮旋转，从而带动从动齿轮旋转，主动齿轮与从动齿轮共同作用使得机械爪子张角变大。齿轮上面是两个摇杆，这样的结构确保了爪子闭合时能够获得较大的夹紧力。连接处应用的是铰制孔螺栓，这样既固定了摇杆又确保了摇杆能够顺利转动。其他连接处采用的是防滑螺丝，确保了机械爪子各部位之间既有间隙又不易脱落。如需要抓取更大宽度的物体可对机械手爪子部分增加张角更大的辅助机械结构。机械手动力系统由六个舵机构成，六个舵机构成了机械手的六个关节，关节转向处采用进口杯式轴承，使得转向更加灵活，确保舵机的转向在同一圆心。这样的机械结构使得机械手具有六个自由度，可在近似半球体空间内将手抓移动到任何一个位置，完成物体的夹持、移位及其放置等任务。机械手的各个动作由六个舵机协同控制完成，机械手具体安装位置如图2所示。从图中可以看出连接的结构主要是铝制的U型架，通过螺丝将U型架与舵机转动轴连接起来。这样当舵机被驱动后，就可带动机械结构一起运动。如果舵机前面旋转轴是固定的，根据作用力与反作用力即可知道舵机驱动后舵机机身就会旋转，进而带动相关的机械结构运动。2研制过程 1）机械部分 四轮Mecanum底盘和多自由度机械手的机械部件通过Pro/E进行建模和装配，分析并推导出了Mecanum四轮优化布局的运动学方程；装配完成了刚性悬架和柔性悬架两种Mecanum轮全向小车，设计过程中避免机械结构存在的干涉问题和不合理结构导致难以加工的问题，然后将三维实体模型导入ADAMS虚拟样机进行运动学、动力学仿真，验证了机械结构的合理性。进一步优化机械结构，提高了项目开发效率。2）控制部分 本项目核心的控制功能是对四轮转速的控制和机械臂的位姿控制，首先将对Mecanum轮运动学和多自由度串联形式的机械臂的运动学进行分析研究，并确定满足系统需求的控制系统方案，随后可以通过MATLAB和ADAMS的联合仿真进行控制算法的编写和调试，通过MATLAB进行了普通直流电机的建模和仿真，编写了基于普通PID算法的编程及调试；并基于STM32高性能单片机设计了Mecanum轮全向小车的整车控制器。最后搭建硬件系统验证控制算法的合理性。2.1虚拟样机设计2.1.1三维建模 (1)Mecanum轮的建模辊子的长度是由Mecannum轮的宽度决定的，我们所选用的轮子的宽度是32mm；由于辊子轴线与轮子轴线成45度角，所以辊子长度L32/sin45mm;再根据结构的情况，辊子长度为30mm建立三维图，如图6所示。图6 辊子的三维图为了保证Mecanum轮在任意时刻都有12辊子与地面接触，我们要通过计算来确定每个轮上辊子的数量。已知参数有：轮子的直径为60mm、辊子的最大直径为12mm、辊子的长度为30mm辊子数量为。由此可取N=8。根据前面的结构分析可以建立Mecanum轮实体模型；如图7所示。图7 Mecanum轮三维图 (2)避震器的建模 避震器的有效长度为100mm，该尺寸是由机器人整体结构所决定的。避震器三维实体模型如 图8所示。图8 避震器三维图 (3)悬臂的建模 图9和图10是悬臂的两个零件，通过三组螺栓螺母的连接构成了悬臂。如图11所示。原本悬臂的结构只有一个零件构成，是一个U型的铝板；但是加工方不能加工这种U型的铝板。最后只能将U型结构拆分成两个L型的零件，通过螺栓螺母连接。图9 悬臂零件1 图10 悬臂零件2图11 悬臂三维图 (4)其它部分模型建模 图12 支撑板