2013简易旋转倒立摆

一．方案论证与比较

1.1.主控方案的选择

1.1.1方案一 STC89C52单片机

STC89C52 是一种带8K字节闪烁可编程可擦除只读存储器的低电压，高性能COMOS8 的微处理器，该器件采用STC高密度非易失存储器制造技术制造，与工业标准的 MCS-51 指令集和输出管脚相兼容。满足题目要求。

图一 STC控制方案

1.2.角度传感器的选择

1.2.1方案一：ADXL345角度传感器

ADXL345采用14引脚塑料封装，具有3mm x 5mm x 1mm的小巧纤薄的外形尺寸。具有高分辨率（3.9 mg/LSB），能够测量约 0.25°的倾角变化。使用 ADXL345 等数字输出加速度计时，可以无需进行模数转换，从而可以节省系统成本和电路板面积。

图二 ADXL345角度传感器

1.3.倾斜角检测方案比较

方案二：双轴倾斜计算

与单轴解决方案一样，x轴检测到的加速度与倾斜角的正弦具有比例关系，同时，与x轴垂直的y轴加速度与倾斜角的余弦成比例。随着某个轴的增量灵敏度的降低，另一轴的灵敏度则会增加。采用第二轴的另一个优势是能够对各个向量进行分区，并能够在整个360度内测量角度。故本设计采用此方案。

1.4.倒立摆系统控制算法的选择

方案一：PID控制

通过对倒立摆系统物理模型进行力学分析，建立其动力学模型，设计出PID 控制器实现稳定控制。PID参数的选择通常采用尝试法进行，但PID方案比较成熟，可以使用。

二．理论分析与计算

2.1双轴倾斜计算

（1）恒定灵敏度

x轴检测到的加速度与倾斜角的正弦具有比例关系，同时，与x轴垂直的y轴加速度与倾斜角的余弦成比例（如图1所示）。随着某个轴的增量灵敏度的降低，另一轴的灵敏度则会增加。

图3 双轴倾斜检测中的输出加速度与倾斜角

将测得加速度转换为倾斜角的一种方法是计算x 轴的反正弦与y 轴的反余弦。然而，一种更简单、更有效的方法是使用来自以下等式的两个值之比：

)

(t a n t a n s i n lg sin lg ,,1

,,A

A A

A OUT

Y OUT

X OUT

Y OUT

X -==??=

θθθθ）

（）

（）

（

其中倾斜角θ单位为弧度。

不同于单轴，利用两个轴之比来确定倾斜角的方法极大地增加了确定增量灵敏度的难度。由于一个轴的增量灵敏度会随着另一轴的减少而增加，因此两者的最终结果是一种几乎恒定的有效增量灵敏度。

（2）对重心面对齐度的依赖行降低

使用双轴或多轴的一个重要优势在于，在单轴解决方案下，除x 轴以外的任何轴发生倾斜都会造成重大误差，与此不同，在使用第二轴时，即使第三轴存在倾斜时也可测得精确的值。这是因为有效增量灵敏度与目标轴重力的和方根（RSS ）值具有比例关系。

当重力完全处于x y 平面之内时，这些轴上检测到的加速度和方根的理想值等于1g 。 如果x z 平面或y z 平面中存在倾斜，则重力导致的总加速度会减少，同时会减少有效增量灵敏度。这又会加大既定加速度计分辨率下的倾斜步长，但仍可提供精确的测量值。经倾斜计算得到的角度对应于x y 平面的旋转。

（3）全角度360度倾斜检测

采用第二个轴的另一个主要优势是能够对各个象限进行分区，并能在整个360度内测量角度。如图2所示，每个象限均拥有与x 轴和y 轴加速度相关联的不同符号组合。

图4 象限检测的倾斜角与加速度符号

若操作数A A OUT Y OUT X ,,/为正，则反正切函数在象限Ⅰ中返回一值；如果该操作数为负，则反正切函数在象限Ⅲ中返回一值。由于象限Ⅳ中的操作数为负，当角度处于该象限时，必须在计算结果中加上180度的值。由于象限Ⅲ中的操作数为正，当角度处于该象限时，必须从计算结果中减去180度的值。计算所得角度的正确象限可通过考察各轴上测得加速度的符号来确定。

（4）反馈调节

图5 反馈调节框图

A ：传感器角度值；T ：设定值；

A-T:传感器角度值与设定值的差值

传感器角度值变化：根据反馈调节理论，控制A-T=0，输入为A-T ，输出为T=A 。在这个调节过程中，由于惯性作用，A 会有一个波动，如图4所示：

图6 角度波动图

2.2电动机的选型 2.2.1刚体受力分析 刚体绕定轴转动微分方程 第 k 个质元

切线方向

在上式两边同乘以rk

对所有质元求和

刚体绕定轴转动微分方程（刚体的转动定律） 2.2.2机械结构的综合考虑

考虑到旋转臂要与电机的转轴合理连接，而碳纤维是一种力学性能优异的新材料，它的比重不到钢的1/4，碳纤维树脂复合材料抗拉强度一般都在3500Mpa 以上，是钢的7~9倍，抗拉弹性模量为230~430Gpa 亦高于钢。因此选择碳纤维杆作为旋转臂。

考虑到摆杆的重心要在一定范围内可调，以选择最佳的力矩与电机配合。因此，我们制作重心可调控制杆作为摆杆。

考虑到摆杆绕轴转动，轴选用直径4MM 的轴承作为转轴。摩擦力小，光滑。

k

k k k a m f F

=+τττk k k k a m f F =+k k k k k k k r a m r f r F τττ=+∑∑∑=+αττ )(2k

k k k k k r m r f r F αJ M =

2.2.3电动机选择

齿轮减速电机，是在普通直流电机的基础上，加上配套齿轮减速箱。齿轮减速箱的作用是，提供较低的转速，较大的力矩。同时，齿轮箱不同的减速比可以提供不同的转速和力矩。这大大提高了，直流电机在自动化行业中的使用率。本文选择ZGA25齿轮减速电机。作为动力装置。

齿轮减速电机是指齿轮减速箱和电机（马达）的组成体。这种组成体通常也可称为齿轮箱电机或减速电机，通常由专业的减速机生产厂进行集成组装好后成套供货。齿轮减速马达的应用非常广泛，属于机械设备不可或缺的动力设备。

2.3驱动与控制算法

2.3.1 PID控制算法

在模拟控制系统中，控制器最常用的控制规律是PID控制。PID控制器又称PID调节器，是工业控制中系统中常用的有源校正装置。可以用软件实现PID控制算法，而且可以利用计算机的逻辑功能，使PID控制更加灵活。数字PID控制生产过程是一种最普遍采用的控制方法。如下图所示。

图7 PID原理

系统的传感器得到的测量结果控制器作出决定通过一个输出设备来作出反应控制器从传感器得到测量结果，然后用需求结果减去测量结果来得到误差。然后用误差来计算出一个对系统的纠正值来作为输入结果，这样系统就可以从它的输出结果中消除误差。

最为理想的控制当属比例-积分-微分控制规律。它集三者之长：既有比例作用的及时迅速，又有积分作用的消除余差能力，还有微分作用的超前控制功能。

当偏差阶跃出现时，微分立即大幅度动作，抑制偏差的这种跃变；比例也同时起消除偏差的作用，使偏差幅度减小，由于比例作用是持久和起主要作用的控制规

律，因此可使系统比较稳定；而积分作用慢慢把余差克服掉。只要三个作用的控制参数选择得当，便可充分发挥三种控制规律的优点，得到较为理想的控制效果。

本方案采用单回路PID控制方案，选取摆杆角度作为反馈信号，此方案间接对摆杆进行控制，系统结构框图如下图所示。

图8PID控制算法

规定这个流程是用来为直流电机调速的;

1.输入量rin(t)为电机转速预定值;

2.输出量rout(t)为电机转速实际值;

3.执行器为直流电机;

4.传感器为光电码盘，假设码盘为10线;

5.直流电机采用PWM调速转速用单位转/min 表示;

6.偏差量为预定值和实际值之差（转/min）;

每个电压对应一个转速，电压和转速之间呈现线性关系。但是我考虑这种方法的前提是把直流电机的特性理解为线性了，而实际情况下，直流电机的特性绝对不是线性的，所以在正式进行调速设计之前，需要现有开环系统，测试电机和转速之间的特性曲线（或者查阅电机的资料说明），然后再进行闭环参数整定。

假设采样间隔为T，则在第K T时刻：

偏差err(K)=rin(K)-rout(K);

积分环节用加和的形式表示，即err(K)+err(K+1)+……;

微分环节用斜率的形式表示，即[err(K)-err(K-1)]/T;

从而形成如下PID离散表示形式：

2.2.2PID子程序流程图

三．硬件电路设计

本系统主要由主控制器模块，角度检测模块，机械结构模块等组成，系统连接图如图所示：

图9系统模块组成

3.1硬件电路设计

硬件电路部分主要由单片机控制模块、电机驱动模块、角度传感器检测模块、电源模块等部分组成，系统原理图如下图所示：

3.1.1 单片机最小系统电路图

图10单片机最小系统图

3.1.2 L298N电机驱动模块电路图

图11电机驱动图3.1.3 角度传感器

图12角度传感器

角度传感器测得X、Y轴方向的重力加速度，通过IIC通信将信号输入单片机，单片机合成数据，得到X、Y轴方向加速度的值，从而计算得出角度值，然后利用屏幕将角度值实时显示出来。

3.2 程序结构与设计

N

程序结构如上图所示，本系统可完成摆杆从处于自然下垂状态（摆角 0°）开始，驱动电机带动旋转臂作往复旋转使摆杆摆动，并尽快使摆角达到或超过-60°~ +60°直至完成圆周运动。

四．测试方案与测试结果

测试方法：1.摆角的检测测试工具：秒表，量角器

在摆杆后1~2CM处固定一个轻质量角器，以方便观察摆杆的旋转角度。测试摆

测试结果分析：理想情况下，摆杆达到正负60度的时间很短，但由于电机转轴和和旋转臂的连接处有摩擦，电机加速控制需要时间，所以，实际测量与理论有差距。

测试方法：2开始到完成第一个圆周运动的时间测试工具：秒表

测试结果分析：当摆杆达到60度的时候，增大电机转速可使摆杆完成圆周运动。因此，从开始状态到完成圆周运动所需的时间很短。本装置完成此项要求的时间比较理想。

测试方法3：外力拉起至165度位置，外力撤出的同时，启动控制旋转臂使摆

测试结果分析：由于装置本身的不稳定性，使旋转臂转动时出现抖动，影响倒立时间的维持。此因素的影响难以消除。

五．总结

本旋转倒立摆能够实现题目的基本要求，并能完成发挥部分的部分功能。但装置稳定性方面还需要进一步改善。

六．参考文献

[1]《模拟电子电路及技术基础》，孙肖子著，西安：西安电子科技大学出版社，2008年；

[2]《自动控制原理》，杨友良著，北京：电子工业出版社，2000年；

[3]《模拟电子线路基础》，吴运昌著，广州：华南理工大学出版社，2004年；

[4]《数字电子技术基础》，阎石著，北京：高等教育出版社，1997年；

[5]《数据结构与算法》，张晓丽等著，北京：机械工业出版社，2002年；

[6]《ARM&Linux嵌入式系统教程》，马忠梅等著，北京：北京航空航天大学出版社，2004年；

[7]《单片机原理及应用》，李建忠著，西安：西安电子科技大学，2002年；附录

一．元器件及材料清单

二．主要程序

#include

#include //Keil library

#include //Keil library

#include

#define uchar unsigned char

#define uint unsigned int

sbit SCL=P2^0; //IIC时钟引脚定义

sbit SDA=P2^1; //IIC数据引脚定义

/*********************电机驱动管脚定义****************************/

sbit en=P1^0;

sbit s1=P1^1;

sbit s2=P1^2;

#define SlaveAddress 0xA6 //定义器件在IIC总线中的从地址,根据ALT ADDRESS地址引脚不同修改

//ALT ADDRESS引脚接地时地址为0xA6，接电源时地址为0x3A

typedef unsigned char BYTE;

typedef unsigned short WORD;

BYTE BUF[8]; //接收数据缓存区

uchar qf,bf,sf,ge,shi,bai,qian,wan; //显示变量

int dis_data,PN; //变量

int data_xyz[3];

uchar i;

***********全局变量*******************************/

uint t=0; /* 中断计数器*/

uchar m1=0; /* 电机1速度值*/

uchar tmp1;

uchar k,table_begin;

uint A,n,C;

void delay(unsigned int k);

void Init_ADXL345(void); //初始化ADXL345

void Single_Write_ADXL345(uchar REG_Address,uchar REG_data); //单个写入数据

uchar Single_Read_ADXL345(uchar REG_Address); //单个读取内部寄存器数据

void Multiple_Read_ADXL345(); //连续的读取内部寄存器数据

//------------------------------------

void Delay5us();

void Delay5ms();

void ADXL345_Start();

void ADXL345_Stop();

void ADXL345_SendACK(bit ack);

bit ADXL345_RecvACK();

void ADXL345_SendByte(BYTE dat);

BYTE ADXL345_RecvByte();

void ADXL345_ReadPage();

void ADXL345_WritePage();

/*******************************/

void delay(unsigned int k)

{

unsigned int i,j;

for(i=0;i

{

for(j=0;j<121;j++)

{;}}

}

/***************************************/

void Delay5us()

{

_nop_();_nop_();_nop_();_nop_();

_nop_();_nop_();_nop_();_nop_();

_nop_();_nop_();_nop_();_nop_();

}

/**************************************

void Delay5ms()

{

WORD n = 560;

while (n--);

}

*****电机处理函数*****************************/ void motor(uchar speed)

{

float read1,read2;

m1=speed;

if(fabs(read()-90.0)<10.0) {

s1=1;

s2=0; }

/* do

{

read1=fabs(read()-90.0);

delay(100);

read2=fabs(read()-90.0);

}while(read2>read1); */

else {

s1=0;

s2=1; }

// delay(180);

/* do

{

read1=fabs(read()-90.0);

delay(100);

read2=fabs(read()-90.0);

}while(read2>read1); */

}

******T0中断服务程序**************************/ void timer0() interrupt 1

{

if(m1==0)

t=0;

if(t==0)/* 1个PWM周期完成后才会接受新数值*/

{

tmp1=m1;

}

if(t

else en=0; /* 产生电机1的PWM信号*/

t++;

if(t>=300) t=0; /* 1个PWM信号由100次中断产生*/ }

//******主程序********

void main()

{

uchar devid;

delay(500); //上电延时

P0=0xFF; //置P0口

P1=0xFF; //置P1口

delay(10); //延时

Init_ADXL345(); //初始化ADXL345

devid=Single_Read_ADXL345(0X00);//读出的数据为0XE5,表示正确ini_timer0();

start();

while(1) //循环

{

motor(200);

}

}