http://www.fxdzw.com/xpzl.htm
悬挂运动控制系统（E题）
一、任务
设计一电机控制系统，控制物体在倾斜（仰角≤100度）的板上运动。
在一白色底板上固定两个滑轮，两只电机（固定在板上）通过穿过滑轮的吊绳控制一物体在板上运动，运动范围为80cm×100cm。物体的形状不限，质量大于100克。物体上固定有浅色画笔，以便运动时能在板上画出运动轨迹。板上标有间距为1cm的浅色坐标线（不同于画笔颜色），左下角为直角坐标原点, 示意图如下。
0 && image.height>0){if(image.width>=510){this.width=510;this.height=image.height*510/image.width;}}" border="0">
二、要求
1、基本要求：
（1）控制系统能够通过键盘或其他方式任意设定坐标点参数；
（2）控制物体在80cm×100cm的范围内作自行设定的运动，运动轨迹长度不小于100cm，物体在运动时能够在板上画出运动轨迹，限300秒内完成；
（3）控制物体作圆心可任意设定、直径为50cm的圆周运动，限300秒内完成；
（4）物体从左下角坐标原点出发，在150秒内到达设定的一个坐标点(两点间直线距离不小于40cm)。
2、发挥部分
（1）能够显示物体中画笔所在位置的坐标；
（2）控制物体沿板上标出的任意曲线运动(见示意图)，曲线在测试时现场标出，线宽1.5cm～1.8cm，总长度约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题）---学生作品
毕业设计（论文） 原创
摘要：悬挂轨迹控制系统是一电机控制系统，控制物体在80cm×100cm的范围内作直线、圆、寻迹等运动，并且在运动时能显示运动物体的坐标。设计采用AT89S51单片机作为核心器件实现对物体运动轨迹的自动控制，通过多圈电位器实现对悬挂物位置的精确测量，并引入局部闭环反馈控制环节对误差进行修正。以达到对物体的控制和对坐标点的准确定位。采用脉冲宽度调制技术控制直流电机驱动芯片L298，以实现对电机的转速、转向、启停等多种工作状态进行快速而准确的控制。采用红外光电传感器实现检测电机速度和画板上黑色曲线轨迹。
关键词：运动轨迹；多圈电位器；脉冲宽度调制；红外反射光电传感；直流电机驱动
ABSTRACT：Hang trajectory control system is a motor control system, object make linear, circle, searching locus and etc locomotion within the range of the 80cm×100cm, while movement system can display the coordinate of the object. Adopt AT89S51 MCU as the main part to realize the automatic control of the object motion locus in this design, system using multiturn potentiometer to measure the position of object, and introduces local closed-loop feedback control system link to correct error, in that case system can improve the accuracy of control and orientation. In this design system also adopt PWM technique control DC motor drive chip L298 to realize the accurate control of motor rotation speed, rotation direction, Start, Stop and etc operating position. System adopt infrared photosensor measure motor rotation speed and drawing locus by black curve on the palette.
KEY WORDS:sport trajectory；loopy potentiometer；PWM；infrared photosensor；DC motor driving
第1章 引 言
运动控制是自动化技术的重要组成部分，是机器人等高技术领域的技术基础，已取得了广泛的工程应用。运动控制集成了电子技术、电机拖动、计算机控制技术等内容，例如在工厂、码头往往需要将货物从一点搬往另一点，如使用悬挂控制系统更方便、安全。在此基础上还可设计成基于三线悬挂结构的运动控制装置。所谓三线悬挂是指，将三根缆线系于一点并悬挂重物，且三根缆线分别挂在三个固定滑轮上，其长度由电机驱动的三个绕线轮分别控制，从而控制悬挂重物在三维空间中的位置。其中原理和悬挂轨迹控制系统一样的。
悬挂轨迹控制系统是一电机控制系统。为满足控制需要，本系统采用AT89S51单片机作为核心器件，多圈电位器为物体位置数据采集器件，以L298驱动的直流电机为执行设备，键盘和LED显示为人机接口的结构方式。算法方面通过以微小直线为单位的策略，完成较为复杂的长直线、圆周和不确定曲线。系统软件将物体运动的坐标转化成悬绳伸缩的距离，进而计算出多圈电位器需要转动到的位置，再算出两直流电机的脉冲宽度调制（PWM）值。再通过A/D转换实现对悬挂物位置的精确测量，并引入局部闭环反馈控制环节对误差进行修正。对于系统自定的确定线型（直线和圆周），通过调整两个直流电机不同的PWM值的搭配，可以控制物体的运动方向。而对于不确定的曲线，由光电传感器得到路线信息，经过单片机的处理，给出物体运动方向的指令。
本设计的主要特点：
1、优化的软件算法，智能化的自动控制，误差补偿。
2、使用双动滑轮，有效防止滑轮与拉绳之间打滑。
3、使用多圈电位器与动滑轮同步转动，引入反馈，实现物体精确定位。
4、LED显示模块提供一个人机对话界面，并实时显示坐标及物体的运动轨迹。
第2章 系统功能及基本原理
1、控制系统能够通过键盘或其他方式任意设定坐标点参数；
2、控制物体在80cm×100cm的范围内作自行设定的运动，运动轨迹长度不小于100cm，物体在运动时能够在板上画出运动轨迹，限300秒内完成；
3、控制物体作圆心可任意设定、直径为50cm的圆周运动，限300秒内完成；
4、物体从左下角坐标原点出发，在150秒内到达设定的一个坐标点(两点间直线距离不小于40cm)；
图2.1 悬挂控制示意图
5、控制物体沿板上标出的任意曲线运动，如图2.1所示，曲线在测试时现场标出，线宽1.5cm～1.8cm，总长度约50cm，颜色为黑色；曲线的前一部分是连续的，长约30cm；后一部分是两段总长约20cm的间断线段，间断距离不大于1cm；沿连续曲线运动限定在200秒内完成，沿间断曲线运动限定在300秒内完成；
6、能够显示物体中画笔所在位置的坐标，运动轨迹与预期轨迹之间的偏差不得超过4cm。
根据设计要求，需要实现勾画设定轨迹和对设定轨迹的搜寻功能，并能实时的显示物体中画笔所在位置坐标。其系统方案框图如图2.2所示。图中多圈电位器安装在两个动滑轮上，电机收放线长度就会通过多圈电位器转换成电压值，通过A/D转换后送入单片机；反射式光电传感器对黑线进行检测，以脉冲信号的形式送入单片机，同时按键信号送入单
片机对物体进行设置校正以及轨迹参数设定，控制器对送来的信号进行分析、运算、处理，将控制信号输送到电机驱动模块，控制电动机的转速,使物体的运动轨迹得以控制。
第3章 方案论证和比较
根据题目要求可知，本系统所涉及的核心问题主要有：
1、对电机的转速、转向、启停等多种工作状态进行快速而准确的控制，以保证悬挂物体按照预先设定或即时设定的运动轨迹运行。
2、为保证该控制系统的精度要求，必须对运动物体在画板上的具体位置（坐标点）进行实时的检测。
3、为保证该运动物体能在尽可能短的时间内按设定运动轨迹从起始点到达目标点，还需要相应的设定及显示电路。
我们分以下几个部分进行方案设计和比较论证。
根据题目要求，控制器主要用于控制电机，并对坐标参数进行处理，控制电机移动方向。对于控制器的选择有以下两种方案。
方案一：采用FPGA为系统的控制器，FPGA可以实现各种复杂的逻辑功能，模块大，密度高，它将所有器件集成在一块芯片上，减少了体积，提高了稳定性，并且可应用EDA软件仿真、调试，易于进行功能控制。FPGA采用并行的输入输出方式，提高了系统的处理速度，适合作为大规模实时系统的控制核心。通过输入模块将参数输入给FPGA，FPGA通过程序设计控制步进电机运动，但是由于本设计对数据处理的时间要求不高，FPGA的高速处理的优势得不到充分体现，并且由于其集成度高，使其成本偏高，同时由于芯片的引脚较多，实物硬件电路板布线复杂，加重了电路设计和实际焊接的工作。
方案二：采用AT89S51作为系统控制的方案。单片机算术运算功能强，软件编程灵活、自由度大，可用软件编程实现各种算法和逻辑控制。由于其功耗低、体积小、技术成熟和成本低等优点，各个领域应用广泛。并且，由于芯片引脚少，在硬件很容易实现。因此，在本设计中采用AT89S51处理输入的数据并控制电机运动。
综合上述两种方案，方案二较为简单，可以满足设计要求。
方案一：采用直流电机。直流电机具有最优越的调速性能，主要表现在调速方便（可无级调速）、调速范围宽、低速性能好（起动转矩大、起动电流小）、运行平稳、噪音低、效率高等方面。
方案二：采用步进电机。步进电机具有控制简单、定位精确、无积累误差等优点。但它在运行时噪音大、高速扭矩小、启动频率低、价格较高。
基于上述比较，为了方便地对电机进行无级调速，和需要电机带负载能力强的特点，这里我们采用直流变速电机。
3.3 驱动及调速方案
方案一：采用继电器对电动机的开和关进行控制，通过开关的切换对电机的速度进行调整。这个方案的优点是电路较为简单，实现容易；缺点是继电器的响应速度慢、机械结构易损坏、寿命较短。
方案二：采用内集成有达林顿管组成的H型的功率变换桥电路的恒压恒流桥式2A驱动芯片。用单片机输出PWM信号控制使之工作在占空比可调的开关状态，通过程序调节占空比精确调整电机转速。这种电路由于工作在管子的饱和截止模式下，效率非常高；H型电路保证了可以简单实现转速和方向的控制；电子开关的速度很快，稳定性也极强，是一种广泛采用的PWM调速技术。