版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领
文档简介
Delta三轴并联机器人研究2Researchonthreeaxisparallelrobot2.1Delta并联机器人研究现状2.1Researchstatusoftriaxialparallelrobot2.1.1运动学研究自从20世纪80年代开始,瑞士的洛桑联邦理工学院就着手研制初代Delta机器人,发展至今,其研究体系、运动学算法相对完整。Delta机器人作为并联机器人的代表,其运动学求解与串联机器人的运动学求解相反。并联机器人的逆向运动学求解比较容易,而正向运动学求解相对复杂。求解位置正逆的方法主要有数值法和解析法。数值法根据并联机器人自身结构的约束关系。建立数值迭代推导求解。此求解方法较为简单。但计算求解的速度较慢,并且不能求得所有的位置解。而解析法的数学理论基础为消元法。既根据机构约束条件,建立约束方程,进而消除约束方程中的未知数,以获得只含有输入变量的多项式。这种方法的好处是可以求得所有的解。但是,如果约束方程比较复杂。消元的求解过程就会比较困难。对于并联机器人而言,其位置逆解的求解相比于正解的求解过程会较为容易一些。根据Heli4并联机器人结构中主动臂与从动臂之间的约束关系。建立起主动臂与从动臂在空间中的位置关系,并用向量表示,以此建立起机构运动学方程,并进一步求解,得到机构位置正逆解的解析表达式。Yangmin
Li在对3-PRC并联机器人的机构进行研究时,运用螺旋理论分析法,并采用消元法获得了正逆解的解析解。对Delta并联机器人的分析,Tsai等对其运动学反解和正解分析计算并仿真。Stan等对机构本身的性能像工作空间、刚度、可操作性等进行分析评估,对机构优化提供理论支持。Zhao对其进行分析了机构的奇异性、各向同性、速度传递性能机构性能评估。赵杰对DELTA机器人模型简化,避开了因数学计算方法带来的计算繁.杂、求解困难等,而是采用了空间几何算法,利用矢量代数计算推导出运动学正解,直观有效的得到满足条件的结果。2.1.2动力学研究在并联机器人的研究中,除了运动学之外,动力学也是一个非常重要的研究方向。动力学的主要研究内容是研究机器人末端运动轨迹和驱动输入端之间的关系。同样,在动力学研究的领域中,根据末端运动和驱动输入这两个变量的不同。动力学求解也分为动力学正解和动力学逆解。动力学正解是根据机器人驱动输入端的参数,求出机器人末端工作点的移动轨迹、速度、和加速度的过程。而动力学逆解,是根据已知的机器人末端工作点的位移、速度和加速度等参数,来求得在此运动条件下。输入端所需要的驱动输入量。在实际用中,因为并联机器人自身的机械结构较为复杂,所以在参数求解的过程中会存在耦合性,在参数的传递过程中也存在非线性性等,这些不确定性因素都会为并联机器人的动力学求解带来一定的困难。根据力学原理知识,对力学求解方法有NewtonEuler法、Lagrange法、虚功原理法、凯恩方程法和Hamilton原理法。这些研究方法普遍存在于机械臂的研究过程中,同样也适用于Delta并联机械臂运动学求解过程。Newton-Euler法较为直观,它主要建立主动臂与从动臂等机械关节之间的力或力矩关系,根据力或力矩平衡原理,即可建立力学模型,但其缺点是以此方法建立的力学模型推导过程较为复杂。Lagrange法主要是以矩阵的形式来建立动力学模型,但其缺点也是推导过程相对复杂。虚功原理法在从雅克比矩阵求解得到并联臂空间位置的速度和加速度映射关系,将机器人末端工作点作为广义坐标,以此建立动力学方程,得到机构运动构件的广义力。凯恩方程法在并联机器人动力学求解中应用较为广泛,以此方法构建的动力学模型的求导过程相对容易。国内外的研发团队针对并联机器人动力学求解作了大量研究,主要成果有:Codourey采用虚功原理对Delta并联机器人进行动力学建模,在模型中运用了等效法,将从动臂的质量等效到了动平台模型上,并且忽略从动臂的运动惯量。Tsai也运用了等效法,在建立动力学模型时不将从动臂质量计入,转而采用Lagrange法建立起并联臂之间的简化动力学模型。MillerK则采用Hamilton原理法对并联机器人的联动力学进行了分析,在进行仿真后将理论计算值与实验结果值进行比较验证。Alain将从动臂的质量分别分解到主动臂和动平台上,并计算分析证明了方法的可行性。张利敏利用虚功原理在不忽略从动臂质量及惯量的情况下建立了更准确地动力学模型。2.1.3机器视觉研究随着大数据样本量的不断增加与计算机单位算力的不断提示,图像处理论的日益成熟,神经网络发展迅猛,机器视觉技术作为其中的佼佼者在生产制造上的应用也逐渐增多。在传统生产机器人自动控制领域,通常采用在控制设备上搭载各种传感器的方法,来实现机器人的智能化,相比之下机器视觉拥有更高的定位精度,更加灵活的装配条件以及更低的成本,并且在机器人误差调整方面具有更强的鲁棒性等。以机器视觉近年的发展来看,能取代大部分生产机器人对特殊传感器的依赖。因其具有的多项优点,使其成为机器人研究方面一个热点问题。在实际应用过程中,机器视觉在工业机器人上也得到了广泛的应用,如避障机器人、导航机器人、流水线上的装配机器人。机器视觉根据视觉设备的数目可以分为单目、双目、多目视觉系统。其中单目视觉较为简单,常用于识别、定位、循迹等作业环境,适用于工作场景单一、识别元素单调、工作线程量较低、目标信息深度较浅等应用场景。而双目视觉和多目视觉可以满足更加复杂的应用需求,它能以多维度,多方位地对目标进行观察,捕捉到更有深度的目标细节信息,但同时多目视觉对视觉系统的稳定性设计要求更高。根据视觉传感器在目标设备上安装的位置不同,视觉系统的工作方式和工作场景也不同。例如以固定机位模式安装视觉传感器,即视觉传感器不随目标运动而发生位移。在这种装配条件下,视觉传感器捕获到视觉范围内的图像,图像再经过算法处理,可得到目标的位姿信息,机器人再利用位姿信息与当前位姿比对,根据偏差运动到理想位置。但是在运动过程中,视觉系统不能跟随机器人末端工作点,进而无法捕获末端工作点的运动轨迹,所以在实际的控制过程中会存在一定误差。与其相对于的装配方式为相对固定安装,即视觉传感器装配在机器人末端,与末端工作点保持同一运动轨迹,这种安装方法能实时捕获末端状态,但运动坐标系相当于目标坐标系是变化的,获取目标准确位置就存在一定难度,所以在实际应用中通常采用混搭装配方式,能更好的满足应用需求。2.1.4运动控制研究实现并联机器人高速、高精度的运动,除了优化机械机构性能以外,还要对运动轨迹规划和采取良好的控制方法来实现。轨迹规划主要为了使机器人末端运动轨迹更加平滑,不会以为在机器人高速运动过程中轨迹出现突变点,引起机器人机构振动而影响机器人工作性能。很多学者借鉴凸轮在高速运动的运动规律,将这种运动规律引入到并联机器人的轨迹规划中,如多项式、摆线、修正梯形曲线等。J.Angeles设计PUMA机器人的在操作空间中内完成抓取放置动作时,采用为三次样条曲线来规划末端运动规律,结果显示优化后的机器人在高速运动时的运动轨平滑并无振动发生。C.Connolly等利用Laplace等式在运动空间进行轨迹规划;Lozano-Perez将运动时间最短作为标准对机器人的运动轨迹进行优化;林士高等在在笛卡尔空间中做PUMA560机器人运动轨迹规划时,将正弦加减速过程引入到运动轨迹启停段,并在轨迹曲线的过度段运用5次多项式曲线过渡,这种轨迹规划使得机器人末端运动速度、加速度平滑连续,在运动.过程中能保持高速运动而且减少机构本体振动和关节磨损。M.Afroun规划最优运动以满足Delta并联机器人工作要求,在满足机构运动学和动力学的前提下,采用合适的动平台操作坐标和二次规划的方法解决由此产生的非线性问题。王攀峰等等针对Diamond二自由度并联机械手提出最优轨迹规划,将时间最短作为优化标准,在操作空间内运用三次样条曲线插补轨迹,分析轨迹误差与关节节点关系,在此基础上,采用复.合型算法,以关节的力矩、速度、加速度和跃度作为约束条件得到时间最优轨迹。经过实验,证明理论方法有效。Angeles等以动能变化率最小为优化指标,提出了一种基于Lame曲线方法。工业工程控制中应用最广是PID控制,其控制参数调整简单、结构改变灵活、鲁棒性强和可靠性高等特点,对于大多数控制对象都能收到良好的效果。其他智能控制方式,如模糊控制、变结构滑模控制、神经网络控制等,应用到并联机器人控制还存在很多问题。模糊控制和变结构控制作为控制器时产生高频颤动,神经网络在合理的确定隐层及隐层内内神经元数问题上存在困难。PID控制器的设计可以基于运动学,利用机器人参数输入与从机器人运动过程中实时采集的运动信息来设计控制器,使机器人能够精确的按照轨迹规划运动。这种方式适合于无耦合的机器人。对于机构存在耦合并且高速运动的并联机器人来说,其运动过程中动力学特性随着位形变化,系统呈现严重的非线性,机构运动的动态特性很难保证。大量的学者对基于动力学的控制方法进行研究。Ghorbe基于模型控制的并联机器人控制。Lee等采用最优控制法。但是由于并联机器人本身的耦合性,不能精确的得到并联机器人动力学模型必然会影响系统动态控制精度。为此,学者一直致力于提高控制器控制精度。CidoureyA简化Delta并联机器人机构,建立动力学模型,推导出.明确的机构惯量矩阵。Walker等采用自适应控制方式来控制并联机构的轨迹运动。Se-HanLee等人提出逆动力学控制实现较高精度的控制。P.Chiacchio等提出了一种.基于模型的线性独立关节控制器策略,通过建立逆动力学模型,分别进行关节参数反馈,从而极大的减小了跟踪误差。2.2Delta并联机器人结构分析(English)2.2.1自由度分析空间中不受约束的刚体,具有三个平动自由度和三个转动自由度,共六个自由度。当刚体之间存在关节性连接后,两两之间就会建立新的约束关系,整体机构的自由度将会随之减少。空间机构分为空间开环机构和空间闭环机构,本设计中的Delta并联机器人是一种典型的空间闭环机构,以下将分析其的自由度的问题。对于空间机构自由度分析,本文采用拥有百年历史的Gribler-Kutzbach自由度计算公式:式中 n代表总构件数目;g代表运动副总数目;f代表第i个运动副本身具有自由度数;F代表机构的自由度。由图中可知,本设计中机构总数n=11,g=3X(主动臂与静平台之间转动副)+12X(从动臂球面副)=15,其中转动副只有一个自由度,而球面副共有三个自由度。因此F=6X(11-15-1)+39=9。但是从动臂两端球面副之间可以自由的围绕连接杆件自身的轴线转动,因此存在自由度的冗余,那么消除冗余自由度的影响之后得到机构最终自由度F=9-6=3。通过分析三自由度Delta并联机器人可知,一条运动链中转动副轴线与从动臂两对球面副的一个自由度运动轴线平行,并在运动过程中一直保持平行,因此,当这种结构的三条运动链形成闭环机构后,末端动平台只可以平动,即与XY平面保持垂直状态,形成分别沿XYZ三个方向自由度。2.2.2工作空间分析工作空间是机器人末端执行器运动达到的所有空间位置点所构成的空间区域,它的大小是机器人结构设计过程中的一个重要组成。工作空间又分为两类:可达工作空间在不考虑机构可能会出现的不合理工作位姿的情况下,机构末端可以达到空间任何方向上任何可达到的点的集合;灵活工作空间是可达工作空间的一部分,机构末端在不损害机器人机构本身并且可以顺畅连续运动到的点的集合51。然而在实际情况下,由于并联机器人结构的特殊性和局限性,它的工作空间范围会受到各种因素的影响:①运动副转角大小。并联机构的球面副、虎克铰、移动副、转动副的行程大小都会影响到并联机器人的末端机构运动的空间位置坐标。②输入转角范围。在主动臂运动过程中,如果转动角度范围太大有可能会和静平台发生干涉,或者机构由于幅度过大毁损机构本身,在运动输入过程中会限制输入转角的范围,这样理论的工作空间位置会达不到,使得工作空间受到限制。一般输入转角的限制可以通过硬件或者软件进行限制,如在.上下极限转角安装限位开关,在软件输入界面设置输入参数限制等。③连杆干涉。杆件本身就有一定的尺寸大小,在运动过程中杆件之间在某个位姿状态下会发生碰撞,这就会影响到机构的运动。这里--般干涉会发生在机构出现奇异位形的情况下。2.3Delta并联臂机械结构设计(English)Delta并联机器人由静平台、动平台、主动臂、从动臂组成基本结构,静平台与动平台通过三条轴对称的运动链连接,而一个主动臂和-一个从动臂组成一条运动链。三个主动臂与静平台分别通过转动副连接,主动臂和从动臂由--对球面副串联成一条运动链,其中从动臂由两条平行杆件和四个球面副组成的闭环平行四边形结构。最后,从动臂上剩下的两个球面副连接从动臂和动平台。安装在静平台上的伺服电机驱动主动臂反复摆动,实现机构末端执行器运动[48],如图2.1所示。2.4Delta并联臂运动学解析(English)2.4.1坐标系建立Delta并联机器人简化示意图如图2.2所示。在机构运动学分析之前,先建立如图坐标系。静平台以中点O为坐标原点,X轴过点E,Z轴垂直于静平台,形成坐标系。同样,动平台以中心为坐标原点,其中X轴过点G,Z轴垂直于动平台。同时,因为静平台只能平动,则动、静平台形成面平行,Z轴z轴空间平行,并且两坐标系建立遵循右手法则。设静平台坐标原点0与主动臂转动副中心E的距离OE,=R,动平台坐标原点0与从动臂一对球面副中心G的距离0G=r,主动臂长度为L。=EF,从动臂L=FG,三个主动臂与静平台之间的转角记为β。其中,i=1,2,3。2.4.2机构运动学逆解对于并联机器人,位置逆解求解即为己知机构末端运动位置情况下,求解主动臂需要转动角度。Delta并联机器人静平台三个连接主动臂的转动副中心三点连线成-一个等边三角形,如图2.3所示。在静平台坐标系0-XYZ中,点E,坐标可表示为:设动平台坐标系原点O'相对于0点位置矢量为O'=[x,y,z]T。同样的,动平台坐标系0-XYZ中,G点位置坐标为:则G'点在O-XYZ坐标系下位置坐标为:图(运动链简化示意图)Delta并联机器人由三条运动链形成闭环,将平行四边形状从动臂简化成一条杆件,如图2.4所示,结合式Fi在静平台坐标系下坐标表示为:联立两式,可以得到运动链中Lb=FG,则运动链约束方程:分别将、、、代入公式中,即可得:令,根据三角函数公式可以得到,,带入式中,联立三个约束方程,整理即可得一个关于的一元二次方程:求一元二次方程的根可得:其中,、、均为已知量,他们的值如下式所示:此时就可以依据公式,在给定Delta并联机器人末端坐标(x,y,z)情况下,求得主动臂三个转动副转过的角度,即伺服电机驱动主动臂转过角度。由式可知,由于每个主动臂转过角度都有两个解,那么三个主动臂转动角度就会有8组值,满足约束方程。但是结合Delta结构的特性,有些转角值的输入会使得主动臂绕转动副向静平台Z轴旋转,如果有两个或三个主动臂这样转动的话会损坏机构,为了避免这种情况,在这里舍去这种情况,那么β取值为:设定Delta并联机器人相关的参数值R=120mm,r=50mm,=195mm,=395mm。下面给出几组动平台中心在运动空间内的坐标值,利用MATLAB数值运算功能去验证上面计算的反解公式,如表2-4-1所示。静平台中心位置坐标(mm)三个自动臂旋转角度值(°)(-100,0,-450)(59.02,29.58,44.96)(0,-100,-450)(53.39,39.87,26.27)(-50,50,-400)(40.34,17.10,17.82)(50,50,-400)(24.20,33.14,17.81)(0,0,-450)(40.38,40.38,40.38)(表2-4-1输入参数求解)2.4.3机构运动学正解 3三轴并联臂SMT应用硬件开发3(English)3.1数字舵机控制驱动开发(English)3.1.1数字舵机选型本课题为了实现对工作点的空间坐标进行高精度控制,采用了以下两种控制算法:①采用模拟舵机方案,使用PWM波控制舵机角度,配合PID控制算法以及路径插补算法实现对工作点的空间坐标控制。②采用可编程数字舵机方案,使用串口通讯协议控制舵机角度,在可编程数字舵机内部寄存器写入PID控制系数,配合异步发送,同步动作算法实现对工作点的空间坐标控制。在经历过研究比对后,方案二的控制精度、软件灵活性明显大于方案一,故最终设计采用方案二——可编程数字舵机方案。可编程数字舵机选用飞特18kgTTL电平双轴串口总线舵机,舵机型号:SCS215,减速比为345:1,内置强磁电机,主要有以下优点:①反应速度灵敏:通讯波特率最高支持1MBps。②转动角度灵活设置:支持0-300°的角度选择和360°连续旋转。③宽电压工作:内部自带宽电压保护,超限自动停止工作。④双工作模式:支持角度控制的伺服模式和循环转动的轮子模式。⑤闭环设计参数反馈:支持温度、速度、电压、负载、位置的参数实时反馈。⑥自卸力保护:当舵机处于过热、过流、过载时、将启动卸力保护。⑦多个舵机串联控制:理论可串联235个舵机单独运动或统一运动。3.1.2舵机通讯协议本课题所采用的数字舵机为串联总线数字舵机,因此多个舵机只需要用一根总线串联起来,通过在不同舵机内部分配id,实现对单个舵机的控制,由于每个舵机出场存在细小差异,以及应用场景不同,在实际应用前还需要单独对每个舵机进行PID校准,以达到最优运动控制状态。舵机的通讯方式如图X所示:图(X)舵机通讯示意图3.1.3舵机控制驱动由于可编程数字舵机只有三根线,分别为电源线:VCC、公共端:GND、数据线:DATA,所以在实际应用过程中,串口TXD和RXD通过数据线DATA进行复用,通过外部硬件电路控制读写使能,严格遵循通信协议,实现读写操作。由图所示,整体通讯逻辑电平为3.3V,利用SN74LVC1G125逻辑门和SN74LVC1G126逻辑门对TXD、RXD串口信号进行输入控制。在TXD信号输入有效时,通过Q1三极管参数一个高电平TXEN,此时SN74LVC1G126使能位置OE有效,DATA数据引脚作为TXD串口信号输入,当TXD信号输入无效时,TXEN被R11拉低,此时SN74LVC1G126使能位置OE非有效,DATA数据引脚作为RXD串口信号输出。图X(数字舵机驱动电路图)3.2步进电机控制驱动开发(English)3.2.1步进电机选型本设计利用三个舵机完成对工作点的空间坐标控制,在实际SMT应用中,因设计者对PCB的布局差异,元器件在平面坐标内将存在360°的旋转角度差值,通常为0°、90°、180°以及其它特殊工艺,为了满足不同场景下的应用需求,在已有的3自由度上还有添加一个平面自由度,用于控制器件的旋转角度,所以本设计采用步进电机进行控制。由于本设计应用场景为元器件表面贴装,所以需要负压泵对元器件实现吸取,在结构上面需要一个密闭的导流通道,因此步进电机需要采用中空轴步进电机。本设计中步进电机型号为鸥柯达(OUKEDA)OK20STH30-0604B高精度步进电机,两相四线,主要有以下优点:①步脚距精度高:8°,5%。②低电压、大力矩:额定3.8V工作电压,18mN.m保持力矩。③质量轻,惯性小:0.06kg,在高速移动中对系统影响小。④欧标轴径:适用于市面上大部分贴片头紧配尺寸,可直接拆卸安装。3.2.2步进电机驱动本设计步进电机驱动采用3D打印机步进电机成熟控制方案,具有精度高,成本低,驱动简单等特点。驱动芯片采用A4988集成控制芯片,是一款完整的微步电机驱动器,内置转换器,操作简便。它设计用于以全步,半步,四分之一,八分之一和十六分之一步模式操作双极步进电机,输出驱动能力高达35V和2A电流。A4988包括一个固定的关断时间电流调节器,能够在慢速或混合衰减模式下工作。只需在STEP引脚上输入一个脉冲就可以驱动电机-一个微步。不需要相序表,高频控制线或复杂的编程接口。A4988非常适合复杂微处理器不可用或负担过重的应用。在步进操作期间,A4988中的斩波控制器自动选择当前衰诚模式,慢速或混合。在混合衰减模式中,设备最初设置为固定关闭时间的一部分的快速衰减,然后设置为关闭时间的剩余部分的缓慢衰减。混合衰减电流控制可降低可听到的电机噪声,提高步进精度并降低功耗。本设计利用单片机输出方波信号至A4988的STEP引脚,实现对步进电机的控制,通过MS1\MS2\MS3选择细分脚距,通过DIR十年控制电机正反转。舵机的驱动输入电压为DC8V,通过串联10欧的电阻连接至电机。逻辑电平输入为3.3V,与MCU、蓝牙等功能块保持一致,方便通讯。3.3蓝牙通讯硬件开发(English)3.3.1蓝牙芯片选型本设计为了方便调试、作业,除了可以利用电脑usb连接外还开发了蓝牙无线传输功能,自定义了通讯协议,可以利用手机APP对本设备进行调试和作业。本设计选用的蓝牙方案为集成模块蓝牙方案,具有通讯距离远,通讯稳定的特点。蓝牙模块型号为WH-BLE103,是一款超低功耗蓝牙4.2模块,可用于点对点数据透明传输及加密传输,用户无需关心传输协议,只需要进行简单的设置就可以进行通讯。本模块主从一体,用户既可以使用两个模块设置一主一从进行数据透传,还可以根据标准的BLE协议开发手机APP进行连接通讯。模块支持一对多广播,简单设置就可以将模块设置为一个广播信号发射端设备,同时内置iBeacon协议,简单的配置就可以作为一个iBeacon设备使用。模块同时支持128bit格式UUID修改,可兼容其他厂家模块通信。是一款多功能,简单,可靠,兼容性强的物联网传输模块。3.3.2蓝牙通讯电路设计针对此模块,设计的外围电路如下图所示:图X(蓝牙通讯接收电路图)本设计中,蓝牙模块通过TXD/RXD串口与单片机或舵机驱动连接,模块电源输入范围为1.7-3.6V,为了与整体设计逻辑电平相匹配,使用电压为3.3V,峰值供电电流30mA。引脚接口采用高频滤波电容,方案为10uF+0.1μF+1nf+100pf。靠率应用环境恶劣以及运动抖动等因素,可能受到ESD干扰或者,所以采用串联磁珠和并联TVS管,以增加模块的稳定性。在整体设计时,首先保证外围电路能够提供充足的供电能力,并且供电范围控制在3.3V左右,供电电压峰值在200mV以内。并在DC/DC后放置大电容,防止外部电源在脉冲电流时间段内出现电压跌落。3.4串口通讯硬件开发(English)3.4.1串口硬件选型本设计为了方便与电脑连接,特此设计了串口转换电路,下位机与电脑通过USB数据线连接,使用MICRO端口,硬件芯片使用CH330将USB信号转换为TTL通讯信号。CH330是USB转串口芯片主要用于将普通串口升级到USB总线,其主要有以下优点:①仿真标准串口,用于升级原串口外围设备,或者通过USB增加额外串口。②计算机端Windows操作系统下的串口应用程序完全兼容,无需修改。③硬件全双工串口,独立的收发缓冲区,支持通讯波特率100bps~2Mbps。④支持7或8个数据位,支持奇校验/偶校验/标志校验/空白校验。⑤通过外加电平转换器件,提供RS232、RS485等接口。⑥支持5V电源电压和3.3V电源电压。图X(CH330通讯示意图)3.4.2串口转换电路设计图X(USB转TTL电路图)3.5主控系统硬件开发(English)3.5.1单片机选型本设计功能较多,运算量较大,需要高性能单片机才能满足作业需求,但是高性能单片机成本与设计理念相悖,所以通过一系列优化手段,例如:将运动学反解计算在上位机完成,步进相位驱动计算用硬件完成,舵机控制采用串口通讯等方案,利用其它硬件将单片机的工作量,计算量分担,最后单片机只剩下电源管理,串口收发等任务,大大降低了单片机的成本。本设计所采用的单片机为STC15W408AS-35I,此款单片机STC中少有的QFN27封装型号,具有体积小,低功耗等特点。3.5.2单片系统设计以下为设计的最小系统图,单片机采用TXD/RXD串口下载程序,P1.0-P1.8负责控制步进电机,外部中断INT0、INT1引出两路开关,用于外部输入调试,因工作量小,发热小,温漂可忽略,故采用内部晶振,节省成本。3.6电源管理硬件开发(English)本设计电源主要包括两个部分,功率电源部分和逻辑电源部分,功率电源主要负责驱动舵机、步进电机、负压泵等用电设备;逻辑电源主要负责驱动单片机、蓝牙模块、转换器、逻辑门等IC及其串口通讯。电源输入为DC9V10A适配器,输入端扇出3路DC9V电压源,第一路经过滤波后直接供给数字舵机,并在输入端口处放置反向击穿值9.1V的稳压二极管,防止浪涌。第二路采用DC-DC降压设计,DC9V经过XL4015降压电路,输出DC5V电源,供给负压泵。第三路采用线性稳压设计,DC9V经过AMS117线性稳压模块,输出DC3.3V,经过电容滤波后供给单品机及其它IC。4三轴并联臂SMT应用软件开发4(English)4.1移动端调试软件开发(English)4.1.1移动端开发思路为了方便对机械臂进行参数设置、状态检测,特此针对Delta并联机械臂开发了一款上位机调试软件,其主要开发思路为:①利用手机运行javascrip代码,对输入的机械臂基本参数动(平台尺寸、静平台尺寸、主动臂长度、从动臂长度)进行运算,得出运动学反解计算时所需要的系数,以及初始化位置。②设计操作界面,让用户可以点击、输入坐标参数,后台代入求得的系数利用javascrip代码对其坐标进行运动学反解运算,得出舵机角度参数。③设计操作界面,让用户可针对蓝牙控制指令,对硬件进行单步、多步、异步、同步调试。④设计反馈界面,让用户能直观读取当然舵机角度、负载、温度、电压、电流信息,针对超过阈值进行安全性处理。⑤利用蓝牙通讯,建立与下位机的通讯,将计算好的舵机角度执行文件传入下位机,以及实时监控下位机读取的舵机、步进电机参数。(APP开发思维导图)4.1.2蓝牙通讯开发上位机蓝牙部分主要采用了JAVA底层代码,对手机自带蓝牙硬件进行调用,在广播扫描上对下位机UUID进行过滤识别,这样能保障上位机与下位机进行一对一通讯,在逻辑和安全上有一点保障。在进行文件下载时采用XMODEM传输协议,XMODEM协议是一种使用拨号调制解调器的个人计算机通信中广泛使用的异步文件运输协议。这种协议以128字节块的形式传输数据,并且每个块都使用一个\t"/item/XMODEM%E5%8D%8F%E8%AE%AE/_blank"校验和过程来进行错误检测。如果接收方关于一个块的\t"/item/XMODEM%E5%8D%8F%E8%AE%AE/_blank"校验和与它在发送方的校验和相同时,接收方就向发送方发送一个认可字节。然而,这种对每个块都进行认可的策略将导致低性能,特别是具有很长传播延迟的卫星连接的情况时,问题更加严重。使用循环\t"/item/XMODEM%E5%8D%8F%E8%AE%AE/_blank"冗余校验的与XMODEM相应的一种协议称为XMODEM-CRC。还有一种是XMODEM-1K,它以1024字节一块来传输数据。ZMODEM是最有效的一个XMODEM版本,它不需要对每个块都进行认可。事实上,它只是简单地要求对损坏的块进行重发。ZMODEM对按块收费的\t"/item/XMODEM%E5%8D%8F%E8%AE%AE/_blank"分组交换网络是非常有用的。不需要认可回送分组在很大程度上减少了通信量。4.1.3delta调试界面开发利用Hbuder软件开发了调试软件,能在手机端直观展现/监控硬件状态,在线对Delta并联臂参数进行调节,对舵机/步进电机进行控制,通过调试软件可以直接读取/设置机械参数、坐标参数、运动参数、舵机参数等能看见Delta主、从动臂夹角,验证当前位置,方便调试。其主要包括:①触控坐标选取功能:用户可以直接在调试软件上选取坐标,进行百分比计算后再逆解出坐标文件下发至下位机,下位机利用坐标文件对舵机进行进行控制,让其达到指定位置,这样就实现了手机对硬件的单步定点控制。②参数实时监控功能:参数主要包括以下四个区块,24条明文参数。<textclass="grace-blue"style="text-align:center;font-size:35rpx;">机械参</text><textstyle="margin-left:40rpx;font-size:28rpx;">静平台外截圆(R):55.00mm</text><textstyle="margin-left:40rpx;font-size:28rpx;">动平台外截圆(r):20.00mm</text><textstyle="margin-left:40rpx;font-size:28rpx;">主动臂长度(L):75.00mm</text><textstyle="margin-left:40rpx;font-size:28rpx;">从动臂长度(l):150.00mm</text><textclass="grace-red"style="text-align:center;font-size:35rpx;">坐标参数</text><textstyle="margin-left:40rpx;font-size:28rpx;">旋转角度(β):0.00°</text><textstyle="margin-left:40rpx;font-size:28rpx;">横向坐标(X):{{zuobiao.X}}mm</text><textstyle="margin-left:40rpx;font-size:28rpx;">纵向坐标(Y):{{zuobiao.Y}}mm</text><textstyle="margin-left:40rpx;font-size:28rpx;">垂直高度(Z):255.00mm</text><textclass="grace-green"style="text-align:center;font-size:35rpx;">运动参数</text><textstyle="margin-left:40rpx;font-size:28rpx;">K1:{{yundong.K1}}</text><textstyle="margin-left:40rpx;font-size:28rpx;">K2:{{yundong.K2}}</text><textstyle="margin-left:40rpx;font-size:28rpx;">M1:{{yundong.M1}}</text><textstyle="margin-left:40rpx;font-size:28rpx;">M2:{{yundong.M2}}</text><textstyle="margin-left:40rpx;font-size:28rpx;">M3:{{yundong.M3}}</text><textstyle="margin-left:40rpx;font-size:28rpx;">K3:{{yundong.K3}}</text><textstyle="margin-left:40rpx;font-size:28rpx;">N1:{{yundong.N1}}</text><textstyle="margin-left:40rpx;font-size:28rpx;">N2:{{yundong.N2}}</text><textstyle="margin-left:40rpx;font-size:28rpx;">N3:{{yundong.N3}}</text><textstyle="margin-left:40rpx;font-size:28rpx;">θ1:{{yundong.J1}}°</text><textstyle="margin-left:40rpx;font-size:28rpx;">θ2:{{yundong.J2}}°</text><textstyle="margin-left:40rpx;font-size:28rpx;">θ3:{{yundong.J3}}°</text><textclass="grace-yellow"style="text-align:center;font-size:35rpx;">舵机参数</text><textstyle="margin-left:40rpx;font-size:2
温馨提示
- 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
- 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
- 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
- 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
- 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
- 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
- 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
最新文档
- 工程材料应急预案(3篇)
- 商务光纤施工方案(3篇)
- 小隧洞施工方案(3篇)
- 保安突发应急预案(3篇)
- 农村药店策划活动方案(3篇)
- 心理创新活动策划方案(3篇)
- 棉条营销创意方案(3篇)
- 沙河火锅活动策划方案(3篇)
- 混凝土灌浆施工方案(3篇)
- 特色柜面活动策划方案(3篇)
- 市政工程施工配合及协调管理措施
- 人防工程质量自评报告
- 2025新人教版七年级下册英语 Unit 1知识点梳理及语法讲义(答案版)
- 竖井井筒支护及安装施工组织方案
- HG/T 6260-2023 塑料 玻纤增强聚苯硫醚(PPS)专用料 (正式版)
- 代付土地使用税协议书
- 金羽年产150mwh高能量密度金属锂电池、15mwh水系锌离子电池生产线项目环境影响报告
- 四川省高等教育自学考试毕业生登记表【模板】
- 《城市轨道交通票务管理》课程标准
- 泌尿男生殖系统其他疾病
- 机电设备及管道安装施工方案
评论
0/150
提交评论