|
自己写的 mini2440 控制步进电机(IO口或者LED)的驱动程序+测试程序,欢迎大家批评
[复制链接]
测试程序如下
#include
#include
#include
#include
int main(int argc, char **argv)
{ int step1[]={0,0,0,1,0,0,1,0,0,1,0,0,1,0,0,0};
int step2[]={};
int step3[]={};
int step4[]={};
int on,i;
int led_no;
int fd;
/*if (argc != 3 || sscanf(argv[1], "%d", &led_no) != 1 || sscanf(argv[2],"%d", &on) != 1 ||
on < 0 || on > 1 || led_no < 0 || led_no > 3) {
fprintf(stderr, "Usage: leds led_no 0|1\n");
exit(1);
}*/
fd = open("/dev/stepmotor0", 0);
if (fd < 0) {
fd = open("/dev/stepmotor", 0);
}
if (fd < 0) {
perror("open device stepmotor");
exit(1);
}
while(1)
{
for(i=0;i<4;i++)
{
ioctl(fd, step1[0+i], 0);
ioctl(fd, step1[4+i], 1);
ioctl(fd, step1[8+i], 2);
ioctl(fd, step1[12+i], 3);
usleep(500*1000);
}
}
close(fd);
return 0;
}
驱动程序如下:
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#include
#define DEVICE_NAME "stepmotor"
static unsigned long led_table [] = {
S3C2410_GPF0,
S3C2410_GPF1,
S3C2410_GPF2,
S3C2410_GPF3,
};
static unsigned int led_cfg_table [] = {
S3C2410_GPF0_OUTP,
S3C2410_GPF1_OUTP,
S3C2410_GPF2_OUTP,
S3C2410_GPF3_OUTP,
};
static int sbc2440_leds_ioctl(
struct inode *inode,
struct file *file,
unsigned int cmd,
unsigned long arg)
{
switch(cmd) {
case 0:
case 1:
if (arg > 4) {
return -EINVAL;
}
s3c2410_gpio_setpin(led_table[arg], !cmd);
return 0;
default:
return -EINVAL;
}
}
static struct file_operations dev_fops = {
.owner = THIS_MODULE,
.ioctl = sbc2440_leds_ioctl,
};
static struct miscdevice misc = {
.minor = MISC_DYNAMIC_MINOR,
.name = DEVICE_NAME,
.fops = &dev_fops,
};
static int __init dev_init(void)
{
int ret;
int i;
for (i = 0; i < 4; i++) {
s3c2410_gpio_cfgpin(led_table, led_cfg_table);
s3c2410_gpio_setpin(led_table, 0);
}
ret = misc_register(&misc);
printk (DEVICE_NAME"\tinitialized\n");
return ret;
}
static void __exit dev_exit(void)
{
misc_deregister(&misc);
}
module_init(dev_init);
module_exit(dev_exit);
MODULE_LICENSE("GPL");
MODULE_AUTHOR("Andrew");
|
|