各个程序均编译通过,insmod 驱动后相应GPE(1)、(4);GPQ(1)、(4)电平为低,至少说明驱动是起些作用的(起机时3个为高,一个为低),但是用ioctl改变值时,测试程序for循环全是GPE(4),GPQ(1)为高,GPE(1),GPQ(4)电平为低。
测试程序可以运行,提示打开驱动成功,ioctl不报错。
大家看看什么问题,谢谢
驱动程序
//////////////////////////////////////////////car_driver.c
#include <linux/miscdevice.h>
#include <linux/delay.h>
#include <asm/irq.h>
//#include <mach/regs-gpio.h>
#include <mach/hardware.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/mm.h>
#include <linux/fs.h>
#include <linux/types.h>
#include <linux/delay.h>
#include <linux/moduleparam.h>
#include <linux/slab.h>
#include <linux/errno.h>
#include <linux/ioctl.h>
#include <linux/cdev.h>
#include <linux/string.h>
#include <linux/list.h>
#include <linux/pci.h>
#include <asm/uaccess.h>
#include <asm/atomic.h>
#include <asm/unistd.h>
#include <mach/map.h>
#include <mach/regs-clock.h>
#include <mach/regs-gpio.h>
#include <mach/gpio.h>
//#include <linux/gpio.h>
#include <plat/gpio-cfg.h>
#include <mach/gpio-bank-e.h>
#include <mach/gpio-bank-q.h>
#define DEVICE_NAME "car"
#define MOTOR_LEFT_ENA S3C64XX_GPE(1)//电机
#define MOTOR_LEFT_ENB S3C64XX_GPE(4)
#define MOTOR_RIGHT_ENA S3C64XX_GPQ(1)
#define MOTOR_RIGHT_ENB S3C64XX_GPQ(4)
static unsigned long motor_table [] = {
MOTOR_LEFT_ENA,
MOTOR_LEFT_ENB,
MOTOR_RIGHT_ENA,
MOTOR_RIGHT_ENB
};
static int car_motor_init(void)
{
int ret=0,i;
for (i = 0; i < 4; i++)
{
if(gpio_is_valid(motor_table)==-EINVAL)
{
printk("ERROR,GPIO used by other devices ! \n");
break;
}
//上拉GPIO
s3c_gpio_setpull(motor_table, S3C_GPIO_PULL_UP);
//设置为输出
s3c_gpio_cfgpin(motor_table, S3C_GPIO_OUTPUT);
//设置默认值为低电平
gpio_set_value(motor_table,0);
}
return ret;
};
static void car_motor_status(void)
{
printk("MOTOR_LEFT_ENA=%d\nMOTOR_LEFT_ENB=%d\nMOTOR_RIGHT_ENA=%d\nMOTOR_RIGHT_ENB=%d\n",
gpio_get_value(MOTOR_LEFT_ENA),
gpio_get_value(MOTOR_LEFT_ENB),
gpio_get_value(MOTOR_RIGHT_ENA),
gpio_get_value(MOTOR_RIGHT_ENB));
};
static void car_motor_run(void)
{
gpio_set_value(MOTOR_LEFT_ENA,1);
gpio_set_value(MOTOR_RIGHT_ENA,1);
};
static void car_motor_stop(void)
{
#if 1
car_motor_status();
#endif
gpio_set_value(MOTOR_LEFT_ENA,0);
gpio_set_value(MOTOR_LEFT_ENB,0);
gpio_set_value(MOTOR_RIGHT_ENA,0);
gpio_set_value(MOTOR_RIGHT_ENB,0);
};
static void car_motor_back(void)
{
gpio_set_value(MOTOR_LEFT_ENB,1);
gpio_set_value(MOTOR_RIGHT_ENB,1);
};
static void car_motor_left(void)
{
gpio_set_value(MOTOR_LEFT_ENB,1);
gpio_set_value(MOTOR_RIGHT_ENA,1);
};
static void car_motor_right(void)
{
gpio_set_value(MOTOR_LEFT_ENA,1);
gpio_set_value(MOTOR_RIGHT_ENB,1);
};
static long car_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
{
long ret=0;
switch(cmd)
{
case '0': case 0:
car_motor_stop();
break;
case '1': case 1:
car_motor_stop();
car_motor_left();
break;
case '3': case 3:
car_motor_stop();
car_motor_back();
break;
case '4': case 4:
car_motor_stop();
car_motor_right();
break;
case '5': case 5:
car_motor_stop();
car_motor_run();
break;
default:
return -EINVAL;
}
return ret;
}
static struct file_operations dev_fops = {
.owner = THIS_MODULE,
.unlocked_ioctl = car_ioctl,
};
static struct miscdevice misc = {
.minor = MISC_DYNAMIC_MINOR,
.name = DEVICE_NAME,
.fops = &dev_fops,
};
static int __init dev_init(void)
{
int ret = 0;
car_motor_init();
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("G.19");
驱动程序Makefile
/////////////////////////////////////////Makefile
ifeq ($(KERNELRELEASE),)
KERNELDIR := /home/fma/8/engine/linux-2.6.38
PWD := $(shell pwd)
modules:
$(MAKE) -C $(KERNELDIR) M=$(PWD) modules
modules_install:
$(MAKE) -C $(KERNELDIR) M=$(PWD) modules_install
clean:
rm -rf *.o *~ core .depend .*.cmd *.ko *.mod.c
.PHONY:modules modules_install clean
else
obj-m := car_driver.o
endif
测试程序
///////////////////////////////////////////////////test.c
#include <stdio.h>
#include <unistd.h>
int main(void)
{
unsigned int cmd = 0;
int fd = -1;
fd = open("/dev/car", 0);
if(fd < 0)
{
printf("open device 'car' error\n");
return -1;
}
printf("open device 'car' successfully.\n");
for(cmd = 0;cmd < 6;cmd++)
{
printf("cmd = %d\n",cmd);
if(-1 == ioctl(fd,cmd,1))
{
printf("ioctl err\n");
}
sleep(10);
}
printf("OK\n");
close(fd);
return 0;
}