树莓派控制五线四相步进电机

同样是大二时候的坑......就不明白了当初为什么不把代码也给贴上去,现在就贴出代码。

#include<stdio.h>
#include<stdlib.h>
#include<wiringPi.h>	//提供GPIO控制函数
#include<unistd.h>	//提供sleep()函数

void DelayMs(int n)
{
	usleep(n*1000);
}

//使树莓派停止
void Step_Stop(int* Ins)
{
	int i;
	for(int i=0;i<=3;i++)
	{
		digitalWrite(Ins[i],0);	//设置为低电平,停止转动
	}
}

//完成一圈的旋转
void Step_Rounds(int* Ins)
{
	int i,j;
	for(i=0;i<4;i++)
	{
		for(j=0;j<4;j++)
		{
			if(i==j)
			{
				digitalWrite(Ins[3-j],1);
			}
			else
			{
				digitalWrite(Ins[3-j],0);
			}
		}
		//DelayMs(20);
	}
}

int main(void)
{
	int A=0,B=1,C=2,D=3;
	int Pin[4]={A,B,C,D};
	int count=100;
	int i;
	pinMode(A,OUTPUT);
	pinMode(B,OUTPUT);
	pinMode(C,OUTPUT);
	pinMode(D,OUTPUT);
	sleep(5);
	for(i=1;i<=count;i++)
	{
		Step_Rounds(Pins);
	}
	Step_Stop(Pins);
	sleep(2);
	printf("Stop!\n");
	return 0;
}
在编译C文件的时候,使用gcc XXX.c -o XXX -lwiringPi指定连接wiringPi库才可以驱动步进电机,之后运行编译好的文件,便可以看到步进电机工作了。

评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值