悬挂运动控制系统（e题）

悬挂运动控制系统（E题）一、任务设计一电机控制系统，控制物体在倾斜（仰角100度）的板上运动。在一白色底板上固定两个滑轮，两只电机（固定在板上）通过穿过滑轮的吊绳控制一物体在板上运动，运动范围为80CM100CM。物体的形状不限，质量大于100克。物体上固定有浅色画笔，以便运动时能在板上画出运动轨迹。板上标有间距为1CM的浅色坐标线（不同于画笔颜色），左下角为直角坐标原点,示意图如下。二、要求1、基本要求（1）控制系统能够通过键盘或其他方式任意设定坐标点参数；（2）控制物体在80CM100CM的范围内作自行设定的运动，运动轨迹长度不小于100CM，物体在运动时能够在板上画出运动轨迹，限300秒内完成；（3）控制物体作圆心可任意设定、直径为50CM的圆周运动，限300秒内完成；（4）物体从左下角坐标原点出发，在150秒内到达设定的一个坐标点两点间直线距离不小于40CM。2、发挥部分（1）能够显示物体中画笔所在位置的坐标；（2）控制物体沿板上标出的任意曲线运动见示意图，曲线在测试时现场标出，线宽15CM18CM，总长度约50CM，颜色为黑色；曲线的前一部分是连续的，长约30CM；后一部分是两段总长约20CM的间断线段，间断距离不大于1CM；沿连续曲线运动限定在200秒内完成，沿间断曲线运动限定在300秒内完成；（3）其他。三、评分标准项目满分设计与总结报告方案比较、设计与论证，理论分析与计算，电路图及有关设计文件，测试方法与仪器，测试数据及测试结果分析。50基本要求实际制作完成情况50完成第1项10完成第2项中连续线段运动14发挥部分完成第2项中断续线段运动16其他10四、说明1、物体的运动轨迹以画笔画出的痕迹为准，应尽量使物体运动轨迹与预期轨迹吻合，同时尽量缩短运动时间；2、若在某项测试中运动超过限定的时间，该项目不得分；3、运动轨迹与预期轨迹之间的偏差超过4CM时，该项目不得分；4、在基本要求3、4和发挥部分2中，物体开始运动前，允许手动将物体定位；开始运动后，不能再人为干预物体运动；5、竞赛结束时，控制系统封存上交赛区组委会，测试用板板上含空白坐标纸测试时自带。悬挂运动控制系统（E题）学生作品毕业设计（论文）原创摘要悬挂轨迹控制系统是一电机控制系统，控制物体在80CM100CM的范围内作直线、圆、寻迹等运动，并且在运动时能显示运动物体的坐标。设计采用AT89S51单片机作为核心器件实现对物体运动轨迹的自动控制，通过多圈电位器实现对悬挂物位置的精确测量，并引入局部闭环反馈控制环节对误差进行修正。以达到对物体的控制和对坐标点的准确定位。采用脉冲宽度调制技术控制直流电机驱动芯片L298，以实现对电机的转速、转向、启停等多种工作状态进行快速而准确的控制。采用红外光电传感器实现检测电机速度和画板上黑色曲线轨迹。关键词运动轨迹；多圈电位器；脉冲宽度调制；红外反射光电传感；直流电机驱动ABSTRACTHANGTRAJECTORYCONTROLSYSTEMISAMOTORCONTROLSYSTEM,OBJECTMAKELINEAR,CIRCLE,SEARCHINGLOCUSANDETCLOCOMOTIONWITHINTHERANGEOFTHE80CM100CM,WHILEMOVEMENTSYSTEMCANDISPLAYTHECOORDINATEOFTHEOBJECTADOPTAT89S51MCUASTHEMAINPARTTOREALIZETHEAUTOMATICCONTROLOFTHEOBJECTMOTIONLOCUSINTHISDESIGN,SYSTEMUSINGMULTITURNPOTENTIOMETERTOMEASURETHEPOSITIONOFOBJECT,ANDINTRODUCESLOCALCLOSEDLOOPFEEDBACKCONTROLSYSTEMLINKTOCORRECTERROR,INTHATCASESYSTEMCANIMPROVETHEACCURACYOFCONTROLANDORIENTATIONINTHISDESIGNSYSTEMALSOADOPTPWMTECHNIQUECONTROLDCMOTORDRIVECHIPL298TOREALIZETHEACCURATECONTROLOFMOTORROTATIONSPEED,ROTATIONDIRECTION,START,STOPANDETCOPERATINGPOSITIONSYSTEMADOPTINFRAREDPHOTOSENSORMEASUREMOTORROTATIONSPEEDANDDRAWINGLOCUSBYBLACKCURVEONTHEPALETTEKEYWORDSSPORTTRAJECTORY；LOOPYPOTENTIOMETER；PWM；INFRAREDPHOTOSENSOR；DCMOTORDRIVING第1章引言运动控制是自动化技术的重要组成部分，是机器人等高技术领域的技术基础，已取得了广泛的工程应用。运动控制集成了电子技术、电机拖动、计算机控制技术等内容，例如在工厂、码头往往需要将货物从一点搬往另一点，如使用悬挂控制系统更方便、安全。在此基础上还可设计成基于三线悬挂结构的运动控制装置。所谓三线悬挂是指，将三根缆线系于一点并悬挂重物，且三根缆线分别挂在三个固定滑轮上，其长度由电机驱动的三个绕线轮分别控制，从而控制悬挂重物在三维空间中的位置。其中原理和悬挂轨迹控制系统一样的。悬挂轨迹控制系统是一电机控制系统。为满足控制需要，本系统采用AT89S51单片机作为核心器件，多圈电位器为物体位置数据采集器件，以L298驱动的直流电机为执行设备，键盘和LED显示为人机接口的结构方式。算法方面通过以微小直线为单位的策略，完成较为复杂的长直线、圆周和不确定曲线。系统软件将物体运动的坐标转化成悬绳伸缩的距离，进而计算出多圈电位器需要转动到的位置，再算出两直流电机的脉冲宽度调制（PWM）值。再通过A/D转换实现对悬挂物位置的精确测量，并引入局部闭环反馈控制环节对误差进行修正。对于系统自定的确定线型（直线和圆周），通过调整两个直流电机不同的PWM值的搭配，可以控制物体的运动方向。而对于不确定的曲线，由光电传感器得到路线信息，经过单片机的处理，给出物体运动方向的指令。本设计的主要特点1、优化的软件算法，智能化的自动控制，误差补偿。2、使用双动滑轮，有效防止滑轮与拉绳之间打滑。3、使用多圈电位器与动滑轮同步转动，引入反馈，实现物体精确定位。4、LED显示模块提供一个人机对话界面，并实时显示坐标及物体的运动轨迹。第2章系统功能及基本原理21设计任务1、控制系统能够通过键盘或其他方式任意设定坐标点参数；2、控制物体在80CM100CM的范围内作自行设定的运动，运动轨迹长度不小于100CM，物体在运动时能够在板上画出运动轨迹，限300秒内完成；3、控制物体作圆心可任意设定、直径为50CM的圆周运动，限300秒内完成；4、物体从左下角坐标原点出发，在150秒内到达设定的一个坐标点两点间直线距离不小于40CM；图21悬挂控制示意图5、控制物体沿板上标出的任意曲线运动，如图21所示，曲线在测试时现场标出，线宽15CM18CM，总长度约50CM，颜色为黑色；曲线的前一部分是连续的，长约30CM；后一部分是两段总长约20CM的间断线段，间断距离不大于1CM；沿连续曲线运动限定在200秒内完成，沿间断曲线运动限定在300秒内完成；6、能够显示物体中画笔所在位置的坐标，运动轨迹与预期轨迹之间的偏差不得超过4CM。22系统基本方案根据设计要求，需要实现勾画设定轨迹和对设定轨迹的搜寻功能，并能实时的显示物体中画笔所在位置坐标。其系统方案框图如图22所示。图中多圈电位器安装在两个动滑轮上，电机收放线长度就会通过多圈电位器转换成电压值，通过A/D转换后送入单片机；反射式光电传感器对黑线进行检测，以脉冲信号的形式送入单片机，同时按键信号送入单片机对物体进行设置校正以及轨迹参数设定，控制器对送来的信号进行分析、运算、处理，将控制信号输送到电机驱动模块，控制电动机的转速,使物体的运动轨迹得以控制。第3章方案论证和比较根据题目要求可知，本系统所涉及的核心问题主要有1、对电机的转速、转向、启停等多种工作状态进行快速而准确的控制，以保证悬挂物体按照预先设定或即时设定的运动轨迹运行。2、为保证该控制系统的精度要求，必须对运动物体在画板上的具体位置（坐标点）进行实时的检测。3、为保证该运动物体能在尽可能短的时间内按设定运动轨迹从起始点到达目标点，还需要相应的设定及显示电路。我们分以下几个部分进行方案设计和比较论证。31控制器模块根据题目要求，控制器主要用于控制电机，并对坐标参数进行处理，控制电机移动方向。对于控制器的选择有以下两种方案。方案一采用FPGA为系统的控制器，FPGA可以实现各种复杂的逻辑功能，模块大，密度高，它将所有器件集成在一块芯片上，减少了体积，提高了稳定性，并且可应用EDA软件仿真、调试，易于进行功能控制。FPGA采用并行的输入输出方式，提高了系统的处理速度，适合作为大规模实时系统的控制核心。通过输入模块将参数输入给FPGA，FPGA通过程序设计控制步进电机运动，但是由于本设计对数据处理的时间要求不高，FPGA的高速处理的优势得不到充分体现，并且由于其集成度高，使其成本偏高，同时由于芯片的引脚较多，实物硬件电路板布线复杂，加重了电路设计和实际焊接的工作。方案二采用AT89S51作为系统控制的方案。单片机算术运算功能强，软件编程灵活、自由度大，可用软件编程实现各种算法和逻辑控制。由于其功耗低、体积小、技术成熟和成本低等优点，各个领域应用广泛。并且，由于芯片引脚少，在硬件很容易实现。因此，在本设计中采用AT89S51处理输入的数据并控制电机运动。综合上述两种方案，方案二较为简单，可以满足设计要求。32电机的选择方案一采用直流电机。直流电机具有最优越的调速性能，主要表现在调速方便（可无级调速）、调速范围宽、低速性能好（起动转矩大、起动电流小）、运行平稳、噪音低、效率高等方面。方案二采用步进电机。步进电机具有控制简单、定位精确、无积累误差等优点。但它在运行时噪音大、高速扭矩小、启动频率低、价格较高。基于上述比较，为了方便地对电机进行无级调速，和需要电机带负载能力强的特点，这里我们采用直流变速电机。33驱动及调速方案方案一采用继电器对电动机的开和关进行控制，通过开关的切换对电机的速度进行调整。这个方案的优点是电路较为简单，实现容易；缺点是继电器的响应速度慢、机械结构易损坏、寿命较短。方案二采用内集成有达林顿管组成的H型的功率变换桥电路的恒压恒流桥式2A驱动芯片。用单片机输出PWM信号控制使之工作在占空比可调的开关状态，通过程序调节占空比精确调整电机转速。这种电路由于工作在管子的饱和截止模式下，效率非常高；H型电路保证了可以简单实现转速和方向的控制；电子开关的速度很快，稳定性也极强，是一种广泛采用的PWM调速技术。方案三采用DSP芯片，配以电机控制所需要的外围功能电路，通过数控电压源调节电机运行速度，实现控制物体的运动轨迹。该方案优点是体积小、结构紧凑、使用便捷、可靠性提高。但系统软硬件复杂、成本高。基于上述理论分析和实际情况，拟定选择方案二。34速度采集方案方案一采用霍尔集成片。该器件内部由三片霍尔金属板组成，当磁铁正对金属板时，由于霍尔效应，金属板发生横向导通，因此可以在电机上安装磁片，而将霍尔集成片安装在固定轴上，通过对脉冲的计数进行电机速度的检测。方案二采用对射式光电传感器。其检测方式为发射器和接受器相互对射安装，发射器的光直接对准接受器，当测物挡住光束时，传感器输出产生变化以指示被测物被检测到。通过脉冲计数，对速度进行测量。由于电机的收线轮直径较小，将传感器安在电机上容易产生测量误差，将传感器安在滑轮上可以减少收线引起的误差。方案三采用多圈电位器式传感器间接测量方式。通过杠杆机构将线位移转化为电阻值的变化，再根据电阻与速度之间的关系实现速度的检测。以上三种方案都是比较可行的方案。尤其是霍尔元件，应用得很广泛。方案一和方案二的精度都会有一定的限制。要达到本设计的要求会给制作带来难度；鉴于此情况选选择多圈电位器更好，远远满足本设计的精度要求。35寻迹模块探测板上黑线的大致原理是光线照射到板面并反射，由于黑线和白纸的反射系数不同，可根据接受到的反射光强弱判断是否偏离黑线。方案一采用热探测器。由于温度变化是因为吸收热能辐射能量引起的，与吸收红外辐射的波长没有关系，即对红外辐射吸收没有波长的选择，因此受外界环境影响比较大。方案二使用发光二极管和光敏三极管组合。这种方案的缺点在于其他环境的光源会对光敏二极管产生很大的干扰。方案三使用红外反射式一体化传感器进行检测。通过对比，这次设计中由于是近距离探测，故采用方案三来完成数据采集。由于红外光波长比可见光长，因此受可见光的影响较小。同时红外线系统还具有以下优点尺寸小、质量轻，便于安装。反射式光电检测器就是其中的一种器件，它具有体积小、灵敏度高、线性好等特点，外围电路简单，安装起来方便，电源要求不高。用它作为近距离传感器是最理想的，电路设计简单、性能稳定可靠。第4章系统硬件设计41系统电路连接及硬件资源分配本系统电路连接及硬件资源分配见图41所示。采用AT89S51单片机作为核心器件，多圈电位器为悬挂物体位置采集器件，通过ADC0832转换位数字信号送入单片机处理，L298作为直流电机的驱动模块，以MAX7219驱动的LED显示和44键盘作为人机接口。42寻轨迹控制策略根据题目的要求，悬挂物沿曲线运动的轨迹分为两段，连续段和间断段。可采用4个光电一体化传感器TCRT5000作为检测元件，其放置方式如图42所示。寻找黑线策略，采用模糊寻找的方式，首先物体从坐标（0，8）运行到坐标（80，8），检测这之间有无黑线，如无，则从坐标（80，16）运行到坐标（0，16），再检测这之间有无黑线，如有，则从坐标（0，12）运行到（80，12），检测，如果没有检测到黑线，再进一步缩小范围从（80，14）运行到（80，14）；如果检测到黑线，再进一步缩小范围从（80，10）运行到（80，10），当检测到黑线时就停下，此处将是黑线起点；如果没有检测到黑线则返回从（80，12）运行到（0，12）检测到的黑线即为黑线起点。以同样的运行检测方式即可寻找出黑线的起点。在连续段寻迹时，通过判断四个传感器的16种组合状态，使电机作出相应的伸缩动作。当轨迹为间断线时，电机拉动传感器在大角度方向内位移，直到在某一方向检测到新的黑线为止。然后再调用连续段的寻迹程序。43系统各模块单元电路设计431电源部分电路设计本系统中使用了直流12V电机，其额定工作电压为12V，而单片机额定工作电压为5V，所以电路中采用了7805和7812作为稳压模块，其最大输出电流为15A，满足系统电机驱动电流的要求，其电路如图431所示。432电机控制模块设计物体运动的轨迹由电机的转速和转向决定，电机的转速和转向的控制是通过多圈电位器对滑轮所转的圈速进行检测，同时通过另一个计数器对时间进行测量，结合两个计数器的值，由单片机计算出电机的速度，而物体运动的轨迹的里程由滑轮的周长和所转的圈数来计算。本系统由单片机直接产生PWM信号，当单片机接受到相应的检测信号时，单片机转到中断口处理信息，PWM信号处于停发状态。将单片机产生的PWM信号经光电隔离器耦合后，控制L298驱动芯片来控制电动机的正反转、启动、制动。原理图如432所示。单片机将P12、P15作为输出控制使能端,P12、P16作为电机一的控制端,P13、P15作为电机二的控制端。L298的两个控制端（C、D）的工作情况由表431列出（VEN为使能端）。表431L298控制表输入功能CHDL正转VENHCLDH反转CD制动VENLCD停止433电机速度采集设计上面在方案论证中已经提出电机速度的数据采集是通过检测滑轮上的转速来得到电机的速度。如图433所示，速度采集系统中使用多圈电位器即图中W1、W2进行检测，然后通过ADC0832进行转换。ADC0832是一个8位双通道A/D转换器件。选用的多圈电位器为10圈、47K，动滑轮直径为5CM，则旋转一圈的线长为L5由ADC0832的分辨率得出，采集到最小线位移为LL/28当电机开始运行时，拖动滑轮转动，多圈电位器和滑轮同步转动，从而改变多圈电位器的输出电压，A/D转换器将多圈电位器的输出电压转换成数字信号送给单片机处理，从而实现对滑轮运转情况精确采集。434寻迹部分电路设计根据设计任务，悬挂物体要沿着黑线运行，采用反射式光电传感器进行探测。光电传感器的硬件设计如图434所示。电压比较器LM393的同相输入IN拉低，输出为低电平。当检测到黑线时，接收管截止，同相输入IN为高，比较器输出为高电平。本系统中四个传感器的OUT分别连接P10P13。435显示模块设计显示部分电路由MAX7219、数码管组成。采用6个LED管进行X轴坐标显示、Y轴坐标显示。其电路图如435所示。436键盘模块电路设计图43644键盘电路原理图根据设计需求，本系统中使用了标准的44键盘，其电路原理图如图436所示。图中C1C4为44键盘的列信号，L1L4为44键盘的行信号。在本系统中，用P00P03连接键盘的列信号C4C1；用P04P07连接键盘的行信号L4L1。在本系统中，S1S3、S5S7、S9S11、S13为数字键，如图28，S4、S8、S12、S14S16为功能键，S2、S5、S7、S10为双功能键。主要功能如图437所示。123方式456X789Y0设置启动确认图43744键盘功能图设置键手动对位或任意设定坐标点参数键，按下后用上、下、左、右键可进行手动对位控制，然后按确认键确认，图438所示。方式键首先按下方式键，然后按数字键选择方式再确认，方式有以下几种方式1归位，让物体自行回到原点。方式2作自行设定的运动。方式3画圆，首先利用数字键设置圆半径进行确认后，再按启动键运行。方式4定点运动，首先利用数字键设置一个坐标点的X、Y值进行确认后，再按启动键运行。方式5寻迹，首先让物体运行在轨迹起点，按下启动键开始寻迹。图439所示，表示了几种方式的操作。启动键用于所选运行方式的开始运行控制键。确认键用于设置、X、Y、方式输入值的确定。第5章软件部分设计51理论分析与计算511位移/数据转换方法首先记录初始A/D转换出来的数据，再使电机1工作，电机2停止，使电机拖动一载体移位100CM，再记录下此期间所变化的A/D转换出的数据，由此则直流电机拉动载体位移1MM所需的数据,因此，直接可将拉线的位移转化为单片机检测A/D转换出来的数值。A/D转换的数值决定位移。512点到点运动核心算法结合图51说明，假设E（X0,Y0）,FX1,Y1为给定平面范围上的任意两点，作辅助线（图中虚线部分），在直角三角形ABE中A02X0152115Y02（51）在直角三角形CDE中B0295X02115Y02（52）同理对于F点，两拉线长分别为A12X1152115Y12（53）B1295X12115Y12（54）因此当悬挂物从E点运动到F点时电机1的收放线长度为C（当C0时，电机反转（或拉线收缩）CA0A1（55）电机2的收放线长度为D（当D0时，电机正转（或拉线伸长）DD0D1（56）根据C，D的正负分别确定电机1，电机2的正反转向。设绳索位移1MMAD变化值为P，而根据C，D的绝对值来确定电位器1，电位器2所要变化的值电位器1所分配的数值M|C|P（57）电位器2所分配的数值N|D|P（58）513误差补偿为了使运动轨迹更加平滑，采用脉冲宽度调制技术控制直流电机驱动芯片L298，以实现对电机的转速工作状态进行快速而准确的控制，设电机1所运行的线值为N,电机2所运行的线值为M，则输出到电机1和电机2的定时器初值比例为N/M，这样可使电机1和电机2同步到达目标点。在点到点运行中，假设电机2的定时器初值为T，则电机1的定时器初始为N/MT，该算法可能会造成电机所运行的路径为一条曲线，可以让单片机不断计算当前点到目标点的距离，不断改变定时器初值，也可以将直线分成几个线段来运行，使得所运行轨迹精度更高，直线更平滑。514数学模型本设计要求悬挂物能够画一个圆，采用微分曲线直线逼近法。首先将圆周等分为N份，将每小份弧线段等效为直线段画出，N越大，曲线就光滑。设所画圆的圆心坐标为（X0,Y0）半径为固定的25CM，（X,Y）为圆周上的任意一点，由此确定圆的方程为XX02YY02252（59）若直接使用该方程来求圆上点的坐标，算法比较复杂，采用了圆的参数方程XX025SINT（510）YY025COST（511）X0,Y0为圆心坐标这样，则圆的坐标仅与参数T有关，因此，使角度T以某一设定的角度步长V累加，使TQV在周期T,T2内变化，其中Q为累加值。这样就可以采样到圆上均匀的点，显然，角度步长V越小，在圆周上取得点越多，控制也会更精确。52程序流程521主流程图本系统软件设计采用汇编语言与C语言交叉使用，为达到题目要求的控制精度和响应时间，针对各项功能设计相应的巧妙算法，采用了汇编语言与C语言交叉使用。系统软件主程序流程图如图2所示程序开始后，首先要对寻迹的光电检测口、MAX7219、电机驱动模块进行初始化，然后判断设置键或方式键是否有按下，以执行设置或几种方式的程序。522定点运动子程序单片机从键盘读入功能键和起始坐标值（X0，Y0），将（X0，Y0）带入式51和式52中计算出A0和B0。再从键盘读入终点坐标值（X1，Y1），也将其带入式53和式54中计算出A1和B1，程序流程图如53所示。图2主程序流程图图53定点运动子程序流程图523画圆子程序根据圆的参数方程的计算圆上点的坐标，通过调用定点程序来实现，画圆程序流程图如图54所示。524寻迹子程序寻迹示意图如图55示，通过判断传感器的不同状态