簡易舵機測試儀

ID:163392 · 發表于 2017-2-16 23:45

在原來電壓顯示器的基礎上稍加修改就成舵機測試儀。對最小時間片和周期有了更深的了解。

//用于測試電壓的用的單片機是 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
}
}