步进电机C语言程序
- 格式：doc
- 大小：38.50 KB
- 文档页数：7
C语言程序清单
#include <stdio.h>
#include <stdlib.h>
#include <conio.h>
#include <bios.h>
#include <ctype.h>
#include <process.h>
void dis(void);
void key(void);
void clear(void);
void ccscan(void);
void action(void);
void putbuf(void);
void getkey(void);
void delay0(int time);
void keyscan(void);
void delay1(int time);
#define IOY0 0x0C400
#define MY8255_A IOY0+0x00*4
#define MY8255_B IOY0+0x01*4
#define MY8255_C IOY0+0x02*4
#define MY8255_MODE IOY0+0x03*4
char a[]={0x6d,0x79,0x73,0x77,0x39,0x06,0x5b,0x4f,0x66,0x80};
char b[]={0x00,0x09,0x04,0x05};
char c[] = {0x10,0x30,0x20,0x60,0x40,0xc0,0x80,0x90};
int dir=1;
int mode=0;
int grd=1;
int cc;
int n;
void main()
{
int i=0;
int j;
outp(MY8255_MODE, 0x81);
while(1)
{
while((i<=7)&&(i>=0))
{
while(1)
{
keyscan();
if(mode==1) break; key();
}
if(dir==1) i++;
if(dir==0) i--;
outp(MY8255_C, c[i]); if(grd==4)
for(j=500;j>0;j--) {
delay1(0x10); keyscan();
}
if(grd==3)
for(j=1000;j>0;j--) {
delay1(0x10); keyscan();
}
if(grd==2)
for(j=3000;j>0;j--) {
delay1(0x10); keyscan();
}
if(grd==1)
for(j=5000;j>0;j--)
{
delay1(0x10); keyscan();
}
key();
}
if(i>7) i=0;
if(i<0) i=7;
}
}
void delay1(int time)
{
int i;
int j;
for(i=0;i<=time;i++)
{
for(j=0;j<=0x700;j++)
{ }
}
return;
}
void keyscan()
{
dis();
clear();
ccscan();
if (cc)
{
dis();
delay0(0x100);
delay0(0x100);
clear();
ccscan();
if (cc)
{
getkey();
putbuf();
}
}
key();
}
void getkey(void)
{
int i;
int j = 0xfe;
for(i=0;i<=3;i++)
{
outp(MY8255_A, j);
if ( !( (inp(MY8255_C)) & 0x01) ) {
n = i + 0;
action();
return;
}
if ( !( (inp(MY8255_C)) & 0x02) ) {
n = i + 4;
action();
return;
}
if ( !( (inp(MY8255_C)) & 0x04) ) {
n = i + 8;
action();
return;
}
if ( !( (inp(MY8255_C)) & 0x08) ) {
n = i + 12;
action();
return;
}
j <<= 1;
}
}
void ccscan(void)
{
outp(MY8255_A, 0x00);
cc = inp(MY8255_C);
cc = (~cc) & 0x0F;
}
void dis(void)
{
int i;
int j = 0xf7;
for(i=3;i>=0;i--)
{
outp(MY8255_A, j);
outp(MY8255_B, a[b[i]]); delay0(0x100);
j >>= 1;
j |= 0x80;
}
}
void clear(void)
{
outp(MY8255_B, 0x00);
}
void action(void)
{
if(n==0)
{
if(dir==1) dir=0; else dir=1;
}
if(n==1)
{
if(mode==1) mode=2; else mode=1;
}
if(n==2)
{
dir=1;
mode=0;
grd=1;
}
if(n==4) grd=1;
if(n==5) grd=2;
if(n==6) grd=3;
if(n==7) grd=4;
}
void putbuf(void)
{
b[0]=mode;
b[2]=dir+3;
b[3]=grd+4;
dis();
clear();
ccscan();
while (cc)
{
dis();
clear();
ccscan();
}
}
void key(void)
{
if (bioskey(1) != 0)
{
exit(0);
}
}
void delay0(int time)
{
int i;
int j;
for(i=0;i<=time;i++)
{
for(j=0;j<=0x100;j++) { }
}
return;
}。
