|
|
#include "reg52.h"
#include<lcd1602.h>
#include "delay.h"
#include "motor4B.h"
sbit K1 = P3^2;//加速
sbit K2 = P3^3;//減速
sbit K3 = P3^4;//正傳
sbit K4 = P3^5;//反轉(zhuǎn)
sbit K5 = P3^6;//啟動(dòng)
sbit K6 = P3^7;//停止
void main( )
{
bit fangxiang = 1;//0是逆時(shí)針
bit kaiqi = 0;//0是停止
int sudu = 4;//每次步進(jìn)間隔時(shí)間為 1ms * sudu,也就是最快每秒25轉(zhuǎn)
char str_buff[] = { "00.00" };
int speed = 0;
init_lcd();
lcd( 0, 0, "LCD_INIT" );
delay( 100 );
lcd( 0, 0, " " );
Init_Motor();
Set_Motor(kaiqi, fangxiang, sudu);
lcd( 1, 0, " reversal " );
lcd( 0, 0, "Speed: " );
lcd( 0, 12, "r/s" );
speed = 1000 / ( 1.0 * 8.0 * sudu ) * 1000;
str_buff[0] = speed / 10000 % 10 + '0';
str_buff[1] = speed / 1000 % 10 + '0';
str_buff[3] = speed / 100 % 10 + '0';
str_buff[4] = speed % 10 + '0';
lcd( 0, 6, str_buff );
while(1)
{
//////////////////////////////////////////////////////////////////////加速
if( K1 == 0 )
{
delay( 50 );
if( K1 == 0 )
{
sudu--;
if( sudu <= 3 )
{
sudu = 4;
}
speed = 1000 / ( 1.0 * 8.0 * sudu ) * 1000;
str_buff[0] = speed / 10000 % 10 + '0';
str_buff[1] = speed / 1000 % 10 + '0';
str_buff[3] = speed / 100 % 10 + '0';
str_buff[4] = speed % 10 + '0';
lcd( 0, 6, str_buff );
Set_Motor(kaiqi, fangxiang, sudu);
// while( K1 == 0 );
}
}
//////////////////////////////////////////////////////////////////////減速
if( K2 == 0 )
{
delay( 50 );
if( K2 == 0 )
{
sudu++;
if( sudu >= 60000 )
{
sudu = 60000;
}
speed = 1000 / ( 1.0 * 8.0 * sudu ) * 1000;
str_buff[0] = speed / 10000 % 10 + '0';
str_buff[1] = speed / 1000 % 10 + '0';
str_buff[3] = speed / 100 % 10 + '0';
str_buff[4] = speed % 10 + '0';
lcd( 0, 6, str_buff );
Set_Motor(kaiqi, fangxiang, sudu);
// while( K1 == 0 );
}
}
//////////////////////////////////////////////////////////////////////正
if( K3 == 0 )
{
delay( 50 );
if( K3 == 0 )
{
fangxiang = 1;
lcd( 1, 0, "Forward rotation" );
Set_Motor(kaiqi, fangxiang, sudu);
while( K3 == 0 );
}
}
//////////////////////////////////////////////////////////////////////反
if( K4 == 0 )
{
delay( 50 );
if( K4 == 0 )
{
fangxiang = 0;
lcd( 1, 0, " reversal " );
Set_Motor(kaiqi, fangxiang, sudu);
while( K4 == 0 );
}
}
//////////////////////////////////////////////////////////////////////啟
if( K5 == 0 )
{
delay( 50 );
if( K5 == 0 )
{
kaiqi = 1;
Set_Motor(kaiqi, fangxiang, sudu);
while( K6 == 0 );
}
}
//////////////////////////////////////////////////////////////////////停
if( K6 == 0 )
{
delay( 50 );
if( K6 == 0 )
{
kaiqi = 0;
Set_Motor(kaiqi, fangxiang, sudu);
while( K6 == 0 );
}
}
}
}
|
|
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
