2013大学生电子设计大赛简易旋转倒立摆及控制装置(C题 )

2015年全国大学生电子设计竞赛简易旋转倒立摆及控制装置（C题）【本科组】2013年9月6日目录1系统方案 (2)1.1电机及驱动方案的论证与选择 (2)1.2传感器采集模块的论证与选择 (2)1.3 控制系统的论证与选择 (2)2系统理论分析与计算 (3)2.1 XXXX的分析 (3)2.1.1 XXX (3)2.1.2 XXX (3)2.1.3 XXX (3)2.2 XXXX的计算 (3)2.2.1 XXX (3)2.2.2 XXX (3)2.2.3 XXX (3)2.3 XXXX的计算 (3)2.3.1 XXX (3)2.3.2 XXX (3)2.3.3 XXX (3)3电路与程序设计 (3)3.1电路的设计 (3)3.1.1系统总体框图 (3)3.1.2 XXXX子系统框图与电路原理图 (4)3.1.3 XXXX子系统框图与电路原理图 (4)3.1.4电源 (4)3.2程序的设计 (4)3.2.1程序功能描述与设计思路 (4)3.2.2程序流程图 (5)4测试方案与测试结果 (5)4.1测试方案 (5)4.2 测试条件与仪器 (5)4.3 测试结果及分析 (6)4.3.1测试结果(数据) (6)4.3.2测试分析与结论 (6)附录1：电路原理图 (7)附录2：源程序 (8)简易旋转倒立摆及控制装置（C题）【本科组】1系统方案本系统主要由电机及驱动模块、传感器采集模块、控制器模块、电源模块组成，下面分别论证这几个模块的选择。

1.1电机及驱动方案的论证与选择方案一：42BY系列混合式步进电机+LN298驱动方案此方案在最先想到以及调试的方案，用步进电机的有点就是正反转切换迅速，无堵转现象，转矩大，负载能力强。

但是42BY系列混合式步进电机响应一拍最小周期为2ms，此时处于电机为最大转速，执行周期长，也就造成系统控制周期长，但是本系统要求调节周期短（我们最终方案采用的是2ms），能够在极短时间内实现一个调节过程，故此方案不能达到预期的效果。

2013 年全国大学生电子设计竞赛试题参赛注意事项（1）9 月4 日8:00 竞赛正式开始。

本科组参赛队只能在【本科组】题目中任选一题；高职高专组参赛队在【高职高专组】题目中任选一题，也可以选择【本科组】题目。

（2）参赛队认真填写《登记表》内容，填写好的《登记表》交赛场巡视员暂时保存。

（3）参赛者必须是有正式学籍的全日制在校本、专科学生，应出示能够证明参赛者学生身份的有效证件（如学生证）随时备查。

（4）每队严格限制3 人，开赛后不得中途更换队员。

（5）竞赛期间，可使用各种图书资料和网络资源，但不得在学校指定竞赛场地外进行设计制作，不得以任何方式与他人交流，包括教师在内的非参赛队员必须回避，对违纪参赛队取消评审资格。

（6）9 月7 日20:00 竞赛结束，上交设计报告、制作实物及《登记表》，由专人封存。

简易旋转倒立摆及控制装置（C 题）【本科组】一、任务设计并制作一套简易旋转倒立摆及其控制装置。

旋转倒立摆的结构如图1 所示。

电动机A 固定在支架B 上，通过转轴F 驱动旋转臂C 旋转。

摆杆E 通过转轴D 固定在旋转臂C 的一端，当旋转臂C 在电动机A 驱动下作往复旋转运动时，带动摆杆E 在垂直于旋转臂C 的平面作自由旋转。

二、要求图1 旋转倒立摆结构示意图1．基本要求（1）摆杆从处于自然下垂状态（摆角0°）开始，驱动电机带动旋转臂作往复旋转使摆杆摆动，并尽快使摆角达到或超过-60°~ +60°；（2）从摆杆处于自然下垂状态开始，尽快增大摆杆的摆动幅度，直至完成圆周运动；（3）在摆杆处于自然下垂状态下，外力拉起摆杆至接近165°位置，外力撤除同时，启动控制旋转臂使摆杆保持倒立状态时间不少于5s；期间旋转臂的转动角度不大于90°。

2．发挥部分（1）从摆杆处于自然下垂状态开始，控制旋转臂作往复旋转运动，尽快使摆杆摆起倒立，保持倒立状态时间不少于10s；（2）在摆杆保持倒立状态下，施加干扰后摆杆能继续保持倒立或2s 内恢复倒立状态；（3）在摆杆保持倒立状态的前提下，旋转臂作圆周运动，并尽快使单方向转过角度达到或超过360°；（4）其他。

#include<stc/STC12C5A60S2.h>#include <math.h>#include <stdio.h>#include <INTRINS.H>typedef unsigned char uchar;typedef unsigned short ushort;typedef unsigned int uint;sbit bmq=P1^5;sbit sn=P1^2;sbit l1=P1^0;sbit l2=P1^1;sbit j1=P0^0;sbit j2=P0^1;sbit j3=P0^2;sbit j4=P0^3;sbit j5=P0^4;sbit j6=P0^5;sbit j7=P0^6;sbit j8=P0^7;unsigned char tttt=0;unsigned char step=0;#define unchar unsigned char#define unint unsigned int#define clear 0x01#define home 0x02#define f_set 0x30#define dis_on 0x0f#define in_mode 0x06sbit P_RS=P2^2;sbit P_RW=P2^1;sbit P_E= P2^0;sbit SCL=P1^6; //IIC时钟引脚定义sbit SDA=P1^7; //IIC数据引脚定义char s[15];//****************************************// 定义MPU6050内部地址//****************************************#define SMPLRT_DIV 0x19 //陀螺仪采样率，典型值：0x07(125Hz)#define CONFIG 0x1A //低通滤波频率，典型值：0x06(5Hz)#define GYRO_CONFIG 0x1B //陀螺仪自检及测量范围，典型值：0x18(不自检，2000deg/s)#define ACCEL_CONFIG 0x1C //加速计自检、测量范围及高通滤波频率，典型值：0x01(不自检，2G，5Hz)#define ACCEL_XOUT_H 0x3B#define ACCEL_XOUT_L 0x3C#define ACCEL_YOUT_H 0x3D#define ACCEL_YOUT_L 0x3E#define ACCEL_ZOUT_H 0x3F#define ACCEL_ZOUT_L 0x40#define TEMP_OUT_H 0x41#define TEMP_OUT_L 0x42#define GYRO_XOUT_H 0x43#define GYRO_XOUT_L 0x44#define GYRO_YOUT_H 0x45#define GYRO_YOUT_L 0x46#define GYRO_ZOUT_H 0x47#define GYRO_ZOUT_L 0x48#define PWR_MGMT_1 0x6B //电源管理，典型值：0x00(正常启用)#define WHO_AM_I 0x75 //IIC地址寄存器(默认数值0x68，只读)#define SlaveAddress 0xD0 //IIC写入时的地址字节数据，+1为读取//****************************************//函数声明//****************************************//MPU6050操作函数void InitMPU6050(); //初始化MPU6050void Delay5us();void I2C_Start();void I2C_Stop();void I2C_SendACK(bit ack);bit I2C_RecvACK();void I2C_SendByte(uchar dat);uchar I2C_RecvByte();void I2C_ReadPage();void I2C_WritePage();uchar Single_ReadI2C(uchar REG_Address); //读取I2C数据void Single_WriteI2C(uchar REG_Address,uchar REG_data); //向I2C写入数据//**************************************//延时5微秒(STC90C52RC@12M)//不同的工作环境,需要调整此函数//当改用1T的MCU时,请调整此延时函数//**************************************void Delay5us(){unsigned char i;i = 22;while (--i);}//**************************************//I2C起始信号//************************************** void I2C_Start(){SDA = 1; //拉高数据线SCL = 1; //拉高时钟线Delay5us(); //延时SDA = 0; //产生下降沿Delay5us(); //延时SCL = 0; //拉低时钟线}//**************************************//I2C停止信号//************************************** void I2C_Stop(){SDA = 0; //拉低数据线SCL = 1; //拉高时钟线Delay5us(); //延时SDA = 1; //产生上升沿Delay5us(); //延时}//**************************************//I2C发送应答信号//入口参数:ack (0:ACK 1:NAK)//************************************** void I2C_SendACK(bit ack){SDA = ack; //写应答信号SCL = 1; //拉高时钟线Delay5us(); //延时SCL = 0; //拉低时钟线Delay5us(); //延时}//**************************************//I2C接收应答信号//**************************************bit I2C_RecvACK(){SCL = 1; //拉高时钟线Delay5us(); //延时CY = SDA; //读应答信号SCL = 0; //拉低时钟线Delay5us(); //延时return CY;}//**************************************//向I2C总线发送一个字节数据//**************************************void I2C_SendByte(uchar dat){uchar i;for (i=0; i<8; i++) //8位计数器{dat <<= 1; //移出数据的最高位SDA = CY; //送数据口SCL = 1; //拉高时钟线Delay5us(); //延时SCL = 0; //拉低时钟线Delay5us(); //延时}I2C_RecvACK();}//**************************************//从I2C总线接收一个字节数据//**************************************uchar I2C_RecvByte(){uchar i;uchar dat = 0;SDA = 1; //使能内部上拉,准备读取数据, for (i=0; i<8; i++) //8位计数器{dat <<= 1;SCL = 1; //拉高时钟线Delay5us(); //延时dat |= SDA; //读数据SCL = 0; //拉低时钟线Delay5us(); //延时}return dat;}//**************************************//向I2C设备写入一个字节数据//**************************************void Single_WriteI2C(uchar REG_Address,uchar REG_data)I2C_Start(); //起始信号I2C_SendByte(SlaveAddress); //发送设备地址+写信号I2C_SendByte(REG_Address); //内部寄存器地址，I2C_SendByte(REG_data); //内部寄存器数据，I2C_Stop(); //发送停止信号}//**************************************//从I2C设备读取一个字节数据//**************************************uchar Single_ReadI2C(uchar REG_Address){uchar REG_data;I2C_Start(); //起始信号I2C_SendByte(SlaveAddress); //发送设备地址+写信号I2C_SendByte(REG_Address); //发送存储单元地址，从0开始I2C_Start(); //起始信号I2C_SendByte(SlaveAddress+1); //发送设备地址+读信号REG_data=I2C_RecvByte(); //读出寄存器数据I2C_SendACK(1); //接收应答信号I2C_Stop(); //停止信号return REG_data;}//**************************************//初始化MPU6050//**************************************void InitMPU6050(){Single_WriteI2C(PWR_MGMT_1, 0x00); //解除休眠状态Single_WriteI2C(SMPLRT_DIV, 0x07);Single_WriteI2C(CONFIG, 0x06);Single_WriteI2C(GYRO_CONFIG, 0x18);Single_WriteI2C(ACCEL_CONFIG, 0x01);}//**************************************//合成数据//**************************************int GetData(uchar REG_Address){char H,L;H=Single_ReadI2C(REG_Address);L=Single_ReadI2C(REG_Address+1);return (H<<8)+L; //合成数据}void bit8_serial_input(unchar ix){unchar i;P_E=0;for(i=0x80;i>=0x01;i=i>>1){if((ix&i)==0) P_RW=0; else P_RW=1;P_E=1;P_E=0;}}void instruct(unchar dat){unchar ch;P_RS=1;ch=0xf8;bit8_serial_input(ch);ch=dat&0xf0;bit8_serial_input(ch);ch=dat<<4;bit8_serial_input(ch);P_RS=0;}void write_abyte(unchar dat){data unchar ch;P_RS=1;ch=0xfa;bit8_serial_input(ch);ch=dat&0xf0;bit8_serial_input(ch);ch=dat<<4;bit8_serial_input(ch);P_RS=0;}void dis_str(unchar x, unchar y, unchar *str) {unchar loc,*p;unchar xline[5]={0,1,3,2,4};p=str;x=xline[x];instruct(home);loc=(16*(x-1)+y-1);if(loc&0x01){loc/=2;instruct(loc|0x80);write_abyte(' ');}else{loc/=2;instruct(loc|0x80);}while(*p){write_abyte(*p++);}}void initial(void){data unchar i,j;P_RS=0;P_E=0;instruct(f_set);for(i=0;i<30;i++){}for(i=0;i<250;i++){}for(i=0;i<250;i++){}instruct(f_set);for(i=0;i<30;i++){}for(i=0;i<250;i++){}for(i=0;i<250;i++){}instruct(0x0c);for(i=0;i<30;i++){}instruct(clear);for(j=0;j<10;j++){for(i=0;i<250;i++){} }instruct(in_mode);for(i=0;i<30;i++){}instruct(home);}int gx,gy,gz,wy;unsigned char PWM1,PWM2,PWM3;unsigned char l;//unsigned int idata atab[91]={0,2,11,26,47,74,107,146,190,241,297,360,428,502,582,668,759,857,959,1068,1182,130 2,1428,1559,1695,1837,1984,2137,2295,2459,2627,2801,2980,3164,3353,3547,3745,3949,4157,4 370,4588,4810,5037,5269,5504,5744,5988,6237,6489,6745,7006,7270,7538,7809,8084,8363,864 5,8931,9219,9511,9806,10104,10405,10709,11015,11324,11635,11949,12266,12584,12905,1322 7,13552,13878,14207,14537,14868,15201,15535,15870,16207,16545,16883,17223,17563,17903, 18245,18586,18928,19271,19613};void Delay50m() //@20.000MHz{unsigned char i, j, k;i = 4;j = 205;k = 187;do{do{while (--k);} while (--j);} while (--i);}void Delay50ms(unsigned char aa){while(aa--)Delay50m();}unsigned char input();void inputstep(){char s[]=" ";unsigned char f=0,num;while(1){initial();dis_str(1,1,"选择\xb9\xfd程");sprintf(s,"%d",(int)step);dis_str(2,1,s);Delay50ms(1);num=input();switch(num){case 16:f=1;break;default:step=num;case 0:break;}if(f)break;}}void saveint(int d){IAP_DATA=d>>8;IAP_TRIG=0x5A;IAP_TRIG=0xA5;IAP_ADDRL++;IAP_DATA=d&0xff;IAP_TRIG=0x5A;IAP_TRIG=0xA5;}void savechar(unsigned char d) {IAP_DATA=d;IAP_TRIG=0x5A;IAP_TRIG=0xA5;}unsigned char readchar(){IAP_TRIG=0x5A;IAP_TRIG=0xA5;return IAP_DATA;}int readint(){int d;IAP_TRIG=0x5A;IAP_TRIG=0xA5;d=IAP_DATA;d<<=8;IAP_ADDRL++;IAP_TRIG=0x5A;IAP_TRIG=0xA5;d+=IAP_DATA;return d;}unsigned char pa1,ps1,pa2,ps2;int getangle();void Delay50us();void inputmode(){char s[]=" ";unsigned char num,t;while(1){initial();dis_str(1,1,"当前角度");sprintf(s,"%d",getangle());dis_str(1,9,s);dis_str(3,1,"角速度");sprintf(s,"%d",GetData(GYRO_YOUT_H)/100-wy);dis_str(3,9,s);Delay50ms(1);if(input()==15)break;}t=PWM1>>4;while(1){initial();while(input()==15);Delay50ms(2);dis_str(4,1,"输入PWM1高四位");sprintf(s,"%d",(int)t);dis_str(1,9,s);Delay50ms(1);num=input();switch(num){case 16:case 0:break;default:t=num;}if(num==16)break;}PWM1&=0x0f;PWM1+=t<<4;t=PWM1&0x0f;while(input()==16);Delay50ms(2);while(1){initial();dis_str(4,1,"输入PWM1低四位");sprintf(s,"%d",(int)t);dis_str(1,9,s);Delay50ms(1);num=input();switch(num){case 16:case 0:break;default:t=num;}if(num==16)break;}PWM1&=0xf0;PWM1+=t;while(input()==16);Delay50ms(2);t=PWM2>>4;while(1){initial();dis_str(4,1,"输入PWM2高四位");sprintf(s,"%d",(int)t);dis_str(1,9,s);Delay50ms(1);num=input();switch(num){case 16:case 0:break;default:t=num;}if(num==16)break;}PWM2&=0x0f;PWM2+=t<<4;t=PWM2&0x0f;while(input()==16);Delay50ms(2);while(1){initial();dis_str(4,1,"输入PWM2低四位");sprintf(s,"%d",(int)t);dis_str(1,9,s);Delay50ms(1);num=input();switch(num){case 16:case 0:break;default:t=num;}if(num==16)break;}PWM2&=0xf0;PWM2+=t;while(input()==16);Delay50ms(2);t=PWM3>>4;while(1){initial();dis_str(4,1,"输入PWM3高四位");sprintf(s,"%d",(int)t);dis_str(1,9,s);Delay50ms(1);num=input();switch(num){case 16:case 0:break;default:t=num-1;}if(num==16)break;}PWM3&=0x0f;PWM3+=t<<4;t=PWM3&0x0f;while(input()==16);Delay50ms(2);while(1){initial();dis_str(4,1,"输入PWM3低四位");sprintf(s,"%d",(int)t);dis_str(1,9,s);Delay50ms(1);num=input();switch(num){case 16:case 0:break;default:t=num-1;}if(num==16)break;}while(input()==16);Delay50ms(2);PWM3&=0xf0;PWM3+=t;t=pa1;while(1){initial();dis_str(4,1,"输入一加速时间");sprintf(s,"%d",(int)t);dis_str(1,9,s);Delay50ms(1);num=input();switch(num){case 16:case 0:break;default:t=num-1;if(num==16)break;}while(input()==16);Delay50ms(2);pa1=t;t=ps1;while(1){initial();dis_str(4,1,"输入一减速时间");sprintf(s,"%d",(int)t);dis_str(1,9,s);Delay50ms(1);num=input();switch(num){case 16:case 0:break;default:t=num-1;}if(num==16)break;}while(input()==16);Delay50ms(2);ps1=t;t=pa2;while(1){initial();dis_str(4,1,"输入二加速时间");sprintf(s,"%d",(int)t);dis_str(1,9,s);Delay50ms(1);num=input();switch(num){case 16:case 0:break;default:t=num-1;if(num==16)break;}while(input()==16);Delay50ms(2);pa2=t;t=ps2;while(1){initial();dis_str(4,1,"输入二减速时间");sprintf(s,"%d",(int)t);dis_str(1,9,s);Delay50ms(1);num=input();switch(num){case 16:case 0:break;default:t=num-1;}if(num==16)break;}while(input()==16);Delay50ms(2);ps2=t;gx=GetData(ACCEL_XOUT_H)/100-164; IAP_CONTR=0x83;IAP_ADDRH=0;IAP_ADDRL=0;IAP_CMD=3;IAP_TRIG=0x5A;IAP_TRIG=0xA5;IAP_CMD=2;saveint(gx);gy=GetData(ACCEL_YOUT_H)/100; IAP_ADDRL++;saveint(gy);gz=GetData(ACCEL_ZOUT_H)/100; IAP_ADDRL++;saveint(gz);wy=GetData(GYRO_YOUT_H)/100;IAP_ADDRL++;saveint(wy);IAP_ADDRL++;savechar(PWM1);IAP_ADDRL++;savechar(PWM2);IAP_ADDRL++;savechar(PWM3);IAP_ADDRL++;savechar(pa1);IAP_ADDRL++;savechar(ps1);IAP_ADDRL++;savechar(pa2);IAP_ADDRL++;savechar(ps2);initial();return;}int x,y,z;int getangle(){x=GetData(ACCEL_XOUT_H)/100+164-gx;y=GetData(ACCEL_YOUT_H)/100-gy;z=GetData(ACCEL_ZOUT_H)/100-gz;if(z<0)x=-x;return x;}void Delay50us() //@20.000MHz{unsigned char i, j;_nop_();_nop_();i = 1;j = 245;do{while (--j);} while (--i);}unsigned char input(){unsigned char state,ps; P0=0xff;while(1){j1=0;Delay50us();state=P0;state=state>>4;ps=0;if(state<15)break;j1=1;j2=0;Delay50us();state=P0;state=state>>4;ps++;if(state<15)break;j2=1;j3=0;Delay50us();state=P0;state=state>>4;ps++;if(state<15)break;j3=1;j4=0;Delay50us();state=P0;state=state>>4;ps++;if(state<15)break;j4=1;break;}switch(state){case 15:return 0;case 14:return 1+4*ps;case 13:return 2+4*ps;case 11:return 3+4*ps;case 7:return 4+4*ps;}return 0;}void rd(){l1=1;l2=0;Delay50ms(pa1);l1=0;Delay50ms(ps1);}unsigned char a;float b;unsigned char reset=0;unsigned char xd,xa;int angle;void main(){InitMPU6050(); //初始化MPU6050IAP_CONTR=0x83;IAP_ADDRH=0;IAP_ADDRL=0;IAP_CMD=1;gx=readint();IAP_ADDRL++;gy=readint();IAP_ADDRL++;gz=readint();IAP_ADDRL++;wy=readint();IAP_ADDRL++;PWM1=readchar();IAP_ADDRL++;PWM2=readchar();IAP_ADDRL++;PWM3=readchar();IAP_ADDRL++;pa1=readchar();IAP_ADDRL++;ps1=readchar();IAP_ADDRL++;pa2=readchar();IAP_ADDRL++;ps2=readchar();TMOD=0X20;TH1=0xfb;TL1=0xfb;SCON=0x50;TR1=1;ES=1;CCON=0;CL=0;CH=0;CMOD=0x02;CCAP0H=CCAP0L=0x20; CCAPM0=0x42;CR=1;EA=1;TI=0;RI=0;/*gx=0;gy=0;gz=0;wy=0;*/initial();dis_str(1,1,"预处理");l=20;initial();dis_str(3,1,"按功能键校准重力"); dis_str(1,2,"3秒后启动……"); for(a=1;a<=20;a++){Delay50ms(1);if(input()==16)inputmode(); }dis_str(1,2,"2秒后启动……"); for(a=1;a<=20;a++){Delay50ms(1);if(input()==16)inputmode(); }dis_str(1,2,"1秒后启动……"); for(a=1;a<=20;a++){Delay50ms(1);if(input()==16)inputmode();}reset=0;step=1;inputstep();if(step==1)rd();if(step==2){l1=1;l2=0;Delay50ms(pa2);l1=0;Delay50ms(ps2);}xa=1;while(1){/*initial();sprintf(s,"%d",GetData(ACCEL_XOUT_H)-gx);dis_str(1,1,s);Delay50ms(1);*//*angle=GetData(ACCEL_XOUT_H);sprintf(s,"%d",angle);dis_str(1,1,s);angle=GetData(ACCEL_YOUT_H);sprintf(s,"%d",angle);dis_str(2,1,s);angle=GetData(ACCEL_ZOUT_H);sprintf(s,"%d",angle);dis_str(3,1,s);angle=getangle();sprintf(s,"%d",angle);dis_str(4,1,s);sprintf(s,"%d",GetData(ACCEL_XOUT_H));dis_str(1,1,s);sprintf(s,"%d",GetData(GYRO_YOUT_H));dis_str(2,1,s);sprintf(s,"%d",GetData(ACCEL_ZOUT_H));dis_str(3,1,s);Delay50ms(1);*/switch(step){case 1:CCAP0H=CCAP0L=PWM1;if(GetData(ACCEL_XOUT_H)-gx>0)if(GetData(GYRO_YOUT_H)-wy>0&&getangle()>0){l1=1;l2=0;}else if(GetData(GYRO_YOUT_H)-wy<0&&getangle()<0){l1=0;l2=1;}else{}else{l1=0;l2=0;}break;case 2:CCAP0H=CCAP0L=PWM2;angle=getangle();if(GetData(GYRO_YOUT_H)-wy>0&&angle>150){l1=1;l2=0;xd=0;}else if(GetData(GYRO_YOUT_H)-wy<0&&angle<-150){l1=0;l2=1;xd=0;}else if(angle<70&&angle>-70){l1=0;l2=0;if(angle>0)xd|=2;else xd|=1;if(xd==3){while(1);}}break;case 3:CCAP0H=CCAP0L=PWM3;if(getangle()<0){l1=1;l2=0;}else{l1=0;l2=1;}break;}if(reset){initial();dis_str(1,1,"\xd5\xfd在烧写程序……");IAP_CONTR=0x60;Delay50ms(40);}}}unsigned char cmd;void RSINTR() interrupt 4{if(RI==1){cmd=SBUF;cmd=cmd<<4;cmd=cmd>>4;if(cmd==0x0e){reset=1;}RI=0;}}。

2014年8月30日旋转倒立摆简易及控制装置（C题）【本科组】参赛队号：20130297简易旋转倒立摆及控制装置(C题)摘要倒立摆的控制是控制理论研究中的一个经典问题，是理想的自动控制教学实验设备，使用它能全方位满足自动控制教学要求，具有模块好和品种多样化等优点。

本组旋转倒立摆系统的稳定性较好，抗干扰能力较强。

机械部分包括旋转臂、摆杆、电动机、转轴、支架。

控制系统设计包括系统硬件电路及软件设计。

硬件部分采用角速度传感器与主控芯片相连，通过角度的测算实时向MCU发送摆杆的状态，MCU通过控制LM298进而控制电机的转向，进而控制摆杆的状态。

主控芯片采用STC12C5A60S2,通过LM298电机驱动与减速直流电机进行通信，并实时用LCD1602液晶显示参数。

软件部分根据最基本的PID算法,给出了程序设计流程图并用C语言编写了控制程序。

关键词：STC12C5A60S2 角速度传感器 LM298AbstractChuangyi Jane round the Chinese dragon light and archaic wall great the Great Wall of the song typeface do regular script variety of body control of inverted pendulum is a classical problem in the study of control theory, is an ideal automatic control teaching experiment equipment, the use of it can meet the requirements of automatic control teaching in all directions, has the advantages of good module and species diversity. This group of rotational inverted pendulum system is of good stability, strong anti-jamming capability. Mechanical parts including rotating arm, swinging rod, motor, shaft and support. Control system design including the system hardware circuit and software design. Hardware part adopts angular velocity sensor is connected to the main control chip, through the Angle of the measured real-time send MCU state of swinging rod, MCU by controlling LM298 and steering control motor, and control the state of the swinging rod. Master control chip USES STC12C5A60S2, through LM298 motor driver communicate with dc motor slowdown, and real-time use LCD1602 LCD display parameters. Software part according to the basic PID algorithm, and gives the flow chart of program design using C language to write the control program.Keywords:STC12C5A60S2 LM298 angular velocity transducer目录一、系统方案 (3)1、总体设计方案 (3)2、方案的比较 (3)2.1 电机的选择 (3)2.2 传感器的选择 (3)2.3 控制系统 (3)二、理论分析与计算 (4)1、理论分析 (4)1.1 角度传感器 (4)1.2 PWM脉冲宽度调制 (4)2、PID算法 (4)三、电路与程序设计 (4)1、电路 (5)1.1 系统总体框图 (5)1.2 最小系统框图 (5)1.3 电源 (5)2、程序流程图 (5)2.1 主程序流程图 (5)2.2 电机驱动子程序流程图 (5)2.3 角度传感器子程序流程图 (5)四、测试方案与测试结果 (6)1、测试方案 (6)1.1 硬件测试 (6)1.2硬件软件联调 (6)2、测试结果及其分析 (6)五、结论 (6)附录：附一：最小系统电路图 (7)附二：程序清单 (8)一、系统方案1、总体设计方案本系统主要由角速度传感器模块、单片机最小系统模块、电机模块、电源模块组成。

2013年全国大学生电子设计竞赛题目：简易旋转倒立摆及控制装置（C题）参赛学校：江苏师范大学队伍编号：XZ 015参赛队员：徐园明、刘海腾、黄波指导教师：朱士虎、王立巍2013年9月7日目录摘要 (1)Abstract (1)1方案论证与比较 (2)1.1电机类型的论证与选择 (2)1.2单片机的论证与选择 (2)1.3电机驱动电路的论证与选择 (2)1.4角度传感器的论证与选择 (3)2系统实现方框图和电路设计 (4)2.1系统总体框架图和实物构架图 (4)2.2硬件电路设计 (5)2.2.1电位器电路 (5)2.2.2显示模块的电路 (5)2.2.3电机驱动电路 (6)3系统软件设计 (7)3.1精密电位器误差计算 (7)3.2倒立摆控制策略 (7)3.3系统流程图 (9)4测试方案与测试结果 (10)4.1测试仪器 (10)4.2测试结果 (10)4.3测试结果分析 (11)参考文献 (12)摘要本文以STC12C5A60S2单片机为控制核心，通过角度传感器实时检测出倒立摆的位置并由单片机计算，计算PID控制算法，实现对直流电机转速的控制，达到倒立摆的动态平衡。

同时系统可以通过键盘设定运行模式和相关角度值，倒立摆运行角度和运行时间由液晶显示，具有较好人机界面。

系统设计结构简单，制作成本低，控制精度高。

关键字：STC12C5A60S2 倒立摆 PIDAbstractThis paper takes STC12C5A60S2 single chip as the control core,Through the real-time detection of the inverted pendulum's position and angle sensor is composed of a single chip computer calculation,Calculation of PID control algorithm,Control the speed of the DC motor,To achieve the dynamic balance of the inverted pendulum.At the same time the system can be set through the keyboard operation mode and related anglevalues.Inverted pendulum movement angle and running time by the liquid crystal display,With good man-machine interface.The system has the advantages of simple structure design,Low production cost,High control precision.Keyword: STC12C5A60S2 level inverted pendulum PID1 方案论证与比较1.1电机类型的论证与选择方案一：采用步进电机。

2013年全国大学生电子设计竞赛试题参赛注意事项（1）9月4日8:00竞赛正式开始。

本科组参赛队只能在【本科组】题目中任选一题；高职高专组参赛队在【高职高专组】题目中任选一题，也可以选择【本科组】题目。

（2）参赛队认真填写《登记表》内容，填写好的《登记表》交赛场巡视员暂时保存。

（3）参赛者必须是有正式学籍的全日制在校本、专科学生，应出示能够证明参赛者学生身份的有效证件（如学生证）随时备查。

（4）每队严格限制3人，开赛后不得中途更换队员。

（5）竞赛期间，可使用各种图书资料和网络资源，但不得在学校指定竞赛场地外进行设计制作，不得以任何方式与他人交流，包括教师在内的非参赛队员必须回避，对违纪参赛队取消评审资格。

（6）9月7日20:00竞赛结束，上交设计报告、制作实物及《登记表》，由专人封存。

简易旋转倒立摆及控制装置（C题）【本科组】一、任务设计并制作一套简易旋转倒立摆及其控制装置。

旋转倒立摆的结构如图1所示。

电动机A固定在支架B上，通过转轴F驱动旋转臂C旋转。

摆杆E通过转轴D固定在旋转臂C的一端，当旋转臂C在电动机A驱动下作往复旋转运动时，带动摆杆E在垂直于旋转臂C的平面作自由旋转。

二、要求图1旋转倒立摆结构示意图1．基本要求（1）摆杆从处于自然下垂状态（摆角0°）开始，驱动电机带动旋转臂作往复旋转使摆杆摆动，并尽快使摆角达到或超过-60°~+60°；（2）从摆杆处于自然下垂状态开始，尽快增大摆杆的摆动幅度，直至完成圆周运动；（3）在摆杆处于自然下垂状态下，外力拉起摆杆至接近165°位置，外力撤除同时，启动控制旋转臂使摆杆保持倒立状态时间不少于5s；期间旋转臂的转动角度不大于90°。

2．发挥部分（1）从摆杆处于自然下垂状态开始，控制旋转臂作往复旋转运动，尽快使摆杆摆起倒立，保持倒立状态时间不少于10s；（2）在摆杆保持倒立状态下，施加干扰后摆杆能继续保持倒立或2s内恢复倒立状态；（3）在摆杆保持倒立状态的前提下，旋转臂作圆周运动，并尽快使单方向转过角度达到或超过360°；（4）其他。

2013年全国大学生电子设计竞赛简易旋转倒立摆及控制装置（C 题）【本科组】2013年9月4日简易旋转倒立摆及控制装置摘要：本作品采用了TI公司MSP430 单片机作为控制器，实现了简易旋转倒立控制系统。

本作品选择两相四线步进电机作为旋转倒立摆的驱动装置，通过精密导电塑料角位移传感器获取摆杆的角度，实现对摆杆E运动状态的检测，以此角位移传感器的测量值作为反馈量，通过PID算法控制步进电机的运动方向和单位时间内运动的步数，实现对摆杆E角度的控制以及倒立摆的起摆和倒立平衡。

本作品可以实现对E摆杆运动状态的检测、倒立摆、起摆以及倒立摆的倒立平衡控制，具有起摆速度快、倒立摆平衡状态稳定、抗干扰能力强等特点。

关键字：旋转倒立摆步进电机 PID算法Abstract:This paper describes a control based on TI's MSP430 microcontroller simple rotary inverted control system. The system uses the West An Jiusheng 57HS56 08 type two-phase four-wire stepper motor as the power source of the system. In WDS35D4 precision conductive plastic angular displacement sensor as the only sensor to realize the system E pendulum motion detection, and so the sensor feedback value as the amount of feedback through software algorithm to determine E pendulum motion by changing the stepper motor the steering and speed to control the state of motion of the pendulum E. Test results had showed that: the system can realize the E pendulum motion detection and control. And the system also has a simple structure, enabling strong, control and stability advantages.Keywords:Rotating balance handstand tepper motor angular displacement一：系统方案1.1 系统结构：本系统主要由以下几部分构成，包括：MSP430单片机、液晶显示模块、矩阵键盘模块、角位移传感器、步进电机驱动模块以及步进电机。

2013年全国大学生电子设计竞赛简易旋转倒立摆及控制装置（C题）【1101003组】2013年9月7日简易旋转倒立摆及控制装置（C题）摘要本系统采用自制的简易旋转倒立摆及控制装置，以16 位单片机(STC89C51)作为旋转倒立摆的检测和控制核心，以额定电压12V的步进电机驱动，通过加速度传感器（ADXL345）转变的角度传感器测定摆杆角度变化来定位摆杆的位置。

系统采用角度传感器（ADXL345）探测在摆杆保持倒立状态的前提下，旋转臂作圆周运动前进；同时通过编码器及PID控制算法实现了步进电机的转速和转向进行调节，以准确找到平衡点位置。

控制器的设计是倒立摆系统的核心内容，主要用到典型的控制器设计理论有PID控制、根轨迹以及频率响应法、状态空间法、最优控制理论等。

本系统可在较短时间内完成摆杆从自然下垂状态，驱动电机带动旋转臂作往复旋转使摆杆摆动，寻找平衡点等任务。

关键词:角度传感器；旋转倒立摆；模糊控制；最优控制理论；目录1系统方案......................................................................................... 错误！未定义书签。

1.1电机方案的论证与选择 (1)1.2 控制系统方案的论证与选择 (2)1.3 角度测量方案的论证与选择 (2)2系统理论分析与计算 (2)2.1 角度检测模块的分析 (2)2.2 控制方法的理论 (3)2.3 设计思想理论分析 (4)2.4 理论计算 (4)3电路与程序设计 (6)3.1电路的设计 (6)3.1.1系统总体框图 (6)3.1.2 电机驱动模块设计 (7)3.1.3 角度传感器模块 (7)3.1.4电源模块 (7)3.2程序的设计 (7)3.2.1程序功能描述与设计思路 (7)3.2.2程序流程图 (8)4测试方案与测试结果 (8)4.1硬件测试 (8)4.2 测试条件与仪器 (9)4.3 测试结果 (9)4.3.1不同脉冲时间间隔对应速度测试 (9)4.3.2摆杆达到指定高度往复运动的时间测试 (10)4.3.3摆杆达到指定度数的测试 (10)4.3.4摆杆选择和配重平衡测试 (10)4.3.5摆杆完成圆周运动测试 (11)4.3.6基本功能（3）测试 (11)4.3.7测试分析与结论 (12)5结束语 (12)6参考文献 (12)附录1：电路原理图 (13)附录2：电机驱动原理图 (14)附录3：稳压模块原理图 (15)附录4：主程序 (16)附录5：角度传感器子程序 (18)简易旋转倒立摆及控制装置（C 题）【本科组】1系统方案本系统主要由系统模块、角度检测模块、电机驱动模块、电源模块组成。

2013年全国大学生电子设计竞赛设计报告题目名称：简易旋转倒立摆及控制装置【本科组C题】参赛队号：201302092013年9月7日2013年“瑞萨杯”全国大学生电子设计竞赛摘要：本系统以STC12C5A60S2单片机最小系统为核心，辅以角度传感器、姿态传感器、开关控制电路、LCD1602显示、电机驱动电路等组成。

该设计利用PWM 调制来控制旋转臂转速的变化，通过角度传感器和姿态传感器检测摆杆角度偏转信号，并将检测到的数值A/D转换后送入调速系统，经LCD1602显示屏进行显示。

也可通过拨码开关控制旋转臂的转速，从而改变摆杆的状态。

该系统实现了通过操作拨码开关控制旋转臂转速的大小，使摆杆状态按要求变化。

关键词：单片机最小系统角位移传感器 A/D转换2013年“瑞萨杯”全国大学生电子设计竞赛目录1.作品简介 (1)2.系统方案论证和比较 (1)2.1系统方案整体实验框图 (1)2.2方案论证与比较 (1)2.1.1输入模块选择 (1)2.1.2调制方式的选择 (2)2.1.3角度传感器的选择 (2)2.1.4显示系统的选择 (2)2.3理论分析与参数计算 (2)2.3.1控制电路 (2)2.3.2角度测量原理与控制算法 (3)3.电路与程序设计 (3)3.1硬件设计 (3)3.1.1角度传感器的设计 (3)3.2软件设计 (3)3.1.1软件主程序流程图 (3)3.1.2程序算法理论分析 (4)4.系统调试与结果分析 (5)4.1系统调试的方法与仪器 (5)4.2系统电路的调试 (5)4.2.1电机的性能测试 (5)4.2.2角度传感器的性能测试 (5)4.3注意事项及解决方案 (6)4.4调试结果分析与总结 (6)5．实验结果的分析与总结 (6)6．参考文献 (6)附录一：部分电路原理图 (1)附录二：程序源代码 (4)1.作品简介本次设计作品以单片机最小系统和角度传感器、姿态传感器为制作核心，同时运用A/D模数转换，PWM调制旋转臂转速、LED声光显示，拨码开关控制等,从摆杆方向上的角位移传感器接收到摆杆角度偏转的信号，经A/D模数转换后，LED显示器进行声光显示。