S3C2440扩展引脚普通IO的驱动源码

 #include <linux/config.h>
#include <linux/fs.h>
#include <linux/module.h>
#include <linux/errno.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <asm/io.h>
#include <asm/uaccess.h>

#define NAME "led_drv"
static int major = 231;
//MODULE_AUTHOR("gec");
//MODULE_DESCRIPTION("LED Driver");
//MODULE_LICENSE("GPL");
//module_param(major, int, 0);
//MODULE_PARM_DESC(major, "Major device number");

#define S3C2410_ADDR(x)   (0xF0000000 + (x))
#define S3C24XX_VA_GPIO    S3C2410_ADDR(0x00E00000)
#define S3C2410_GPIOREG(x) ((x) + S3C24XX_VA_GPIO)

#define S3C2410_GPACON    *((volatile unsigned long*)S3C2410_GPIOREG(0x00))
#define S3C2410_GPADAT    *((volatile unsigned long*)S3C2410_GPIOREG(0x04))

// 用到B6,B0?
// Port B
#define S3C2410_GPBCON    *((volatile unsigned long*)S3C2410_GPIOREG(0x10))
#define S3C2410_GPBDAT    *((volatile unsigned long*)S3C2410_GPIOREG(0x14))
#define S3C2410_GPBUP    *((volatile unsigned long*)S3C2410_GPIOREG(0x18))
//用到G7,G6?
// Port G
#define S3C2410_GPGCON    *((volatile unsigned long*)S3C2410_GPIOREG(0x60))
#define S3C2410_GPGDAT    *((volatile unsigned long*)S3C2410_GPIOREG(0x64))
#define S3C2410_GPGUP    *((volatile unsigned long*)S3C2410_GPIOREG(0x68))

#define Led1_ON()       (S3C2410_GPBDAT &= ~(1<<6))
#define Led1_OFF()      (S3C2410_GPBDAT |= (1<<6))
#define Led2_ON()       (S3C2410_GPBDAT &= ~(1<<0))
#define Led2_OFF()      (S3C2410_GPBDAT |= (1<<0))
#define Led3_ON()       (S3C2410_GPGDAT &= ~(1<<7))
#define Led3_OFF()      (S3C2410_GPGDAT |= (1<<7))
#define Led4_ON()       (S3C2410_GPGDAT &= ~(1<<6))
#define Led4_OFF()      (S3C2410_GPGDAT |= (1<<6))

 

/*
 * LedDisp函数根据参数led来显示相应的Led。
 */
void LedDisp(int led)
{
    int mask;
    // 某位位置为1点亮,否则熄灭,可无限添加更多效果
    // 0 全灭, 1-4依次单独点亮灯1-4,熄灭其余
    int arr_mask[] = {0,1,2,3,4,5,6,7,8,9,10,11,12,13,14,15,};// 效果掩码
    if( led < 0 || led >= (sizeof(arr_mask)/sizeof(arr_mask[0])) )
        return;
    mask = arr_mask[led];// 根据输入的数字选择效果

    (mask & (1<<0)) ?  Led1_ON() :  Led1_OFF(); // 对应位置为1点亮,否则熄灭
    (mask & (1<<1)) ?  Led2_ON() :  Led2_OFF();
    (mask & (1<<2)) ?  Led3_ON() :  Led3_OFF();
    (mask & (1<<3)) ?  Led4_ON() :  Led4_OFF();
}

static int led_drv_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
{
 printk("led- ioctl: param %u %lu/n", cmd, arg);
    LedDisp(arg);
 return 0;
}

static int led_drv_open(struct inode *inode, struct file *file)
{
  unsigned m = iminor(inode);
  if (m > 63)
   return -EINVAL;
  printk("LED driver opened!/n");
  return nonseekable_open(inode, file);
}

static int led_drv_release(struct inode *inode, struct file *file)
{
  printk("LED driver released!/n");
  return 0;
}

static struct file_operations led_drv_fops = {
  .owner   = THIS_MODULE,
  .ioctl   = led_drv_ioctl,
  .open    = led_drv_open,
  .release = led_drv_release,
};

static int __init led_drv_init(void)
{
    int temp;
 int ret;
 unsigned long tmp;
  printk("LED Driver./n");
 /* 注册LED设备 */
 ret = register_chrdev(major, NAME, &led_drv_fops);
  if (ret < 0) {
    printk("Unable to register character device!/n");
    return ret;
  }
 /*
  *初始化GPA－IO寄存器
  */
  // B6,B0,G7,G6 for output
 temp = S3C2410_GPBCON & (~((3<<12) | (3<<0))); // 屏蔽
 S3C2410_GPBCON = temp | (1<<12) | (1<<0);

 temp = S3C2410_GPGCON & (~((3<<14) | (3<<12))); // 屏蔽
 S3C2410_GPGCON = temp | (1<<14) | (1<<12);

    // 是否上拉
    S3C2410_GPBUP &= ~((1<<6) | (1<<0));  // enable poll up
    S3C2410_GPGUP &= ~((1<<7) | (1<<6));  // enable poll up

    //S3C2410_GPBUP |= (1<<6) | (1<<0);  // disable poll up
    //S3C2410_GPGUP |= (1<<7) | (1<<6);  // disable poll up

    // 初始化B6,B0,G7,G6输出高电平,可能点亮或者熄灭LED
    S3C2410_GPBDAT |= (1<<6) | (1<<0);
    S3C2410_GPGDAT |= (1<<7) | (1<<6);

 printk("LED Test Driver initiated./n");
 return 0;
}
static void __exit led_drv_cleanup(void)
{
  int ret;
  ret = unregister_chrdev(major, NAME);
  if (ret < 0)
    printk("Unable to register character device!/n");
  else
    printk("LED Test Driver unloaded!");
}
module_init(led_drv_init);
module_exit(led_drv_cleanup);