TQ2440 led测试 GPB5

循环控制LED GPB5 的亮灭

#include <linux/module.h>
#include <linux/types.h>
#include <linux/fs.h>
#include <linux/errno.h>
#include <linux/mm.h>
#include <linux/sched.h>
#include <linux/init.h>
#include <linux/cdev.h>
#include <asm/io.h>
#include <asm/system.h>
#include <asm/uaccess.h>

#include<mach/regs-gpio.h>
#include<mach/hardware.h>


#define LED_MAJOR 244

#define IOCTL_LED_ON     1
#define IOCTL_LED_OFF    0

static int led_major = LED_MAJOR;

struct cdev *led_devp; /*设备结构体指针*/

int led_open(struct inode *inode, struct file *filp)
{
  return 0;
}

int led_release(struct inode *inode, struct file *filp)
{
  return 0;
}


static int led_ioctl(struct inode *inodep, struct file *filp, unsigned
  int cmd, unsigned long arg)
{
    switch(cmd)
    {
        case IOCTL_LED_ON:
            s3c2410_gpio_setpin(S3C2410_GPB5,0);
            return 0;
        case IOCTL_LED_OFF:
            s3c2410_gpio_setpin(S3C2410_GPB5,1);
            return 0;
        default:
            return -EINVAL;

    }
}

void led_gpio_init(void)
{
    s3c2410_gpio_cfgpin(S3C2410_GPB5,S3C2410_GPB5_OUTP);
    s3c2410_gpio_setpin(S3C2410_GPB5,0);
}
/*文件操作结构体*/
static const struct file_operations led_fops =
{
  .owner = THIS_MODULE,
  .ioctl = led_ioctl,
  .open = led_open,
  .release = led_release,
};
#if 0
/*初始化并注册cdev*/
static void led_setup_cdev(struct led_dev *dev, int index)
{
  int err, devno = MKDEV(led_major, index);

  cdev_init(&dev->cdev, &led_fops);
  dev->cdev.owner = THIS_MODULE;
  dev->cdev.ops = &led_fops;
  err = cdev_add(&dev->cdev, devno, 1);
  if (err)
    printk(KERN_NOTICE "Error %d adding LED%d", err, index);
}

#endif

/*设备驱动模块加载函数*/
int led_init(void)
{
  int result;
  dev_t devno = MKDEV(led_major, 0);

  /* 申请设备号*/
  if (led_major)
    result = register_chrdev_region(devno, 1, "led-control");
  else  /* 动态申请设备号 */
  {
    result = alloc_chrdev_region(&devno, 0, 1, "led-control");
    led_major = MAJOR(devno);
  }
  if (result < 0)
    return result;

  /* 动态申请设备结构体的内存*/
 // led_devp = kmalloc(sizeof(struct led_dev), GFP_KERNEL);
  led_devp=cdev_alloc();
  if (!led_devp)    /*申请失败*/
  {
    result =  - ENOMEM;
    goto fail_malloc;
  }
  memset(led_devp, 0, sizeof(struct cdev));

#if 0
  led_setup_cdev(led_devp, 0);
#endif
/**********************************************/
  cdev_init(led_devp,&led_fops);
  led_devp->owner=THIS_MODULE;
  led_devp->ops=&led_fops;
  result=cdev_add(led_devp,MKDEV(led_major,0),1);
  if(result)
     printk(KERN_NOTICE "Error %d adding LED%d", result, 0);
/*************************************************/
  led_gpio_init();
  printk(KERN_INFO "init ok\n");
  return 0;

  fail_malloc: unregister_chrdev_region(devno, 1);
  return result;
}

/*模块卸载函数*/
void led_exit(void)
{
  cdev_del(led_devp);   /*注销cdev*/
  kfree(led_devp);     /*释放设备结构体内存*/
  unregister_chrdev_region(MKDEV(led_major, 0), 1); /*释放设备号*/
  printk(KERN_INFO "bye the crul world!\n");
}


MODULE_LICENSE("Dual BSD/GPL");
module_init(led_init);
module_exit(led_exit);

应用程序

#include<stdio.h>
#include<unistd.h>
#include<stdlib.h>
#include<sys/ioctl.h>
#include<sys/types.h>
#include<sys/stat.h>
#include<fcntl.h>
#include<sys/select.h>
#include<sys/time.h>

int main(void)
{
    int fp;
    fp=open("/dev/led-control",0);
    if(fp<0)
    {
        perror("open bad \n");
        return 0;
    }

    while(1)
    {
        ioctl(fp,0);
        printf("led off\n");
        sleep(1);
        ioctl(fp,1);
        printf("led on\n");
        sleep(1);
    }
    return 0;
}