简易舵机测试仪 - - Powered by Discuz!

//用于测试电压的用的单片机是 STC15F408AS
#include <reg51.h>
#include<intrins.h>
void Display(unsigned int num);//用于数码管显示具体数字显示0到9直接用相应的数字做参数，显示1到9 加个点用1到9乘以10做参数 0加一个点用11做参数
void Display_num(unsigned int num,unsigned char weizhi); // 用于确认那个数码管显示数字。第一参数num是要显示的数字，第二个参数weizhi是要在哪个数码管显示（最左边为1，最右边为4）
void Delay10us(); //@12.000MHz
void delay_n_10us(unsigned int n);
unsigned int a; //保存模数转换后的数据
sfr P2M0=0x96; //声明 P2引脚模式寄存器
sfr P3M0=0xb2; //声明 P3引脚模式寄存器
sfr P5=0xc8;
sfr P1ASF=0x9D; //声明 P1口模拟功能寄存器 p1.7开启模拟功能
sfr ADC_RES=0xBD; //声明 ADC转换结果寄存器
sfr ADC_CONTR=0xBC;//声明 ADC控制寄存器
sbit OUT=P5^5;//定义一个输出引脚
unsigned int L; //用于存储读出的PWM
unsigned char count;//用于存储次数
unsigned char displaytime;
unsigned int data1,data2,data3; //用于存储PWM的个位和十位和百位
sbit DA=P2^4; //数码管每个引脚
sbit DB=P3^2;
sbit DC=P3^6;
sbit DD=P2^0;
sbit DE=P2^1;
sbit DF=P2^3;
sbit DG=P3^5;
sbit DP=P3^7;
sbit B1=P2^5; //四个数码管的引脚定义用于控制哪个数码管亮
sbit B2=P2^2;
sbit B3=P3^3;
sbit B4=P3^4;
void main()
{
P2M0=0x1B; //需要高电平大电流的引脚 2.4、2.3、2.1、2.0，填入数值0001 1011
P3M0=0xE4; //需要高电平大电流的引脚 3.7、3.6、3.5、3.2，填入数值1110 0100
//B1=B2=B3=B4=0;
while(1)
{
delay_n_10us(400);
count++;
if(count>4)
{
count=0;
B1=B2=B3=B4=0; //暂时关闭数码管防止闪烁
//开始模--数转换
P1ASF=0x80;
ADC_CONTR=0X88+7;
delay_n_10us(5);
a=ADC_RES;
L=a;//先将读数给PWM
//输出PWM
if(L>200) //如果时间大于2ms，从1ms重新开始
{
L=200;
}
else if(L<100) //如果时间小于2ms，从1ms重新开始
{
L=100;
}
OUT=1;
delay_n_10us(L);//输出高电平
OUT=0;
data3=L/100;
data2=L%100/10;
data1=L%10;
}
displaytime++;
if(displaytime>2)
displaytime=0;
if(displaytime==0)
Display_num(data1,4); //显示个位
if(displaytime==1)
Display_num(data2,3); //显示十位
if(displaytime==2)
Display_num(data3*10,2); //显示百位
}
}
void Display(unsigned int num) //显示0到9直接用相应的数字做参数，显示1到9 加个点用1到9乘以10做参数 0加一个点用11做参数
{
switch(num)
{
case 0:
{
DA=0; DB=0; DC=0; DD=0; DE=0; DF=0; DG=1; DP=1; //显示0
break;
}
case 1:
{
DA=1; DB=0; DC=0; DD=1; DE=1; DF=1; DG=1; DP=1; //显示1
break;
}
case 2:
{
DA=0; DB=0; DC=1; DD=0; DE=0; DF=1; DG=0; DP=1; //显示2
break;
}
case 3:
{
DA=0; DB=0; DC=0; DD=0; DE=1; DF=1; DG=0; DP=1; //显示3
break;
}
case 4:
{
DA=1; DB=0; DC=0; DD=1; DE=1; DF=0; DG=0; DP=1; //显示4
break;
}
case 5:
{
DA=0; DB=1; DC=0; DD=0; DE=1; DF=0; DG=0; DP=1; //显示5
break;
}
case 6:
{
DA=0; DB=1; DC=0; DD=0; DE=0; DF=0; DG=0; DP=1; //显示6
break;
}
case 7:
{
DA=0; DB=0; DC=0; DD=1; DE=1; DF=1; DG=1; DP=1; //显示7
break;
}
case 8:
{
DA=0; DB=0; DC=0; DD=0; DE=0; DF=0; DG=0; DP=1; //显示8
break;
}
case 9:
{
DA=0; DB=0; DC=0; DD=0; DE=1; DF=0; DG=0; DP=1; //显示9
break;
}
case 10:
{
DA=1; DB=0; DC=0; DD=1; DE=1; DF=1; DG=1; DP=0; //显示1加个点
break;
}
case 11:
{
DA=0; DB=0; DC=0; DD=0; DE=0; DF=0; DG=1; DP=0; //显示0 加个点
break;
}
case 20:
{
DA=0; DB=0; DC=1; DD=0; DE=0; DF=1; DG=0; DP=0; //显示2 加个点
break;
}
case 30:
{
DA=0; DB=0; DC=0; DD=0; DE=1; DF=1; DG=0; DP=0; //显示3 加个点
break;
}
case 40:
{
DA=1; DB=0; DC=0; DD=1; DE=1; DF=0; DG=0; DP=0; //显示4 加个点
break;
}
case 50:
{
DA=0; DB=1; DC=0; DD=0; DE=1; DF=0; DG=0; DP=0; //显示5 加个点
break;
}
case 60:
{
DA=0; DB=1; DC=0; DD=0; DE=0; DF=0; DG=0; DP=0; //显示6 加个点
break;
}
case 70:
{
DA=0; DB=0; DC=0; DD=1; DE=1; DF=1; DG=1; DP=0; //显示7 加个点
break;
}
case 80:
{
DA=0; DB=0; DC=0; DD=0; DE=0; DF=0; DG=0; DP=0; //显示8 加个点
break;
}
case 90:
{
DA=0; DB=0; DC=0; DD=0; DE=1; DF=0; DG=0; DP=0; //显示9 加个点
break;
}
default :
{
DA=1; DB=1; DC=1; DD=1; DE=1; DF=1; DG=1; DP=1; //全灭
break;
}
}
}
void Display_num(unsigned int num,unsigned char weizhi)
{
switch(weizhi)
{
case 1:
{
B1=1; B4=0;B2=0;B3=0;
Display(num);
break;
}
case 2:
{
B2=1; B1=0;B3=0;B4=0;
Display(num);
break;
}
case 3:
{
B3=1; B1=0;B2=0;B4=0;
Display(num);
break;
}
case 4:
{
B4=1; B1=0;B2=0;B3=0;
Display(num);
break;
}
}
}
void Delay10us() //@12.000MHz
{
unsigned char i;
_nop_();
_nop_();
i = 24;
while (--i);
}
void delay_n_10us(unsigned int n) //延时n个10us的函数
{
while(n)
{
Delay10us();
n=n-1;//每循环一次n减小1
}
}

复制代码