myled.c

#include
#include
#include
#include
#include
#include
#include
#include
#include
/*#include "gpio-nrs.h"*/

//add tsuibin

#include
#include
#include
#include

#include
#include
#include

#include

#define MYLED_COUNT 1
#define MYLED_NAME "myled"
#define S3C2410_GPB5 S3C2410_GPB(5)
#define S3C2410_GPB6 S3C2410_GPB(6)
#define S3C2410_GPB7 S3C2410_GPB(7)
#define S3C2410_GPB8 S3C2410_GPB(8)

// S3C2410_GPIO_OUTPUT
static struct cdev myled_cdev;
static struct class *myled_class;
static struct device *myled_device;

static unsigned long led_table[] = {
  S3C2410_GPB (5),
  S3C2410_GPB (6),
  S3C2410_GPB (7),
  S3C2410_GPB (8),
};

ssize_t
myled_read (struct file *filp, char __user * buf, size_t count,
     loff_t * f_pos)
{
  return 0;
}

ssize_t
myled_write (struct file * filp, const char __user * buf, size_t count,
      loff_t * f_pos)
{

  unsigned int pin;
  unsigned int led_off = 0;
  unsigned long offs;
  unsigned long flags;
  unsigned long dat;
  void *base;

  pin = buf[0] - '0';
  if (buf[1] == '0')
    {
      led_off = 1;
    }
  if (pin >= 4 || pin < 0)
    return -1;

  pin = led_table[pin];

  base = S3C24XX_GPIO_BASE (pin);
  offs = S3C2410_GPIO_OFFSET (pin);
  local_irq_save (flags);

  dat = __raw_readl (base + 0x04);
  dat &= ~(1 << offs);
  dat |= led_off << offs;
  __raw_writel (dat, base + 0x04);

  local_irq_restore (flags);

  return count;
}

int
myled_ioctl (struct inode *inode, struct file *filp, unsigned int cmd,
      unsigned long arg)
{

  return 0;
}

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

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

struct file_operations myled_fops = {
  .owner = THIS_MODULE,
  .read = myled_read,
  .write = myled_write,
  .ioctl = myled_ioctl,
  .open = myled_open,
  .release = myled_release,
};

static int __init
myled_init (void)
{
  int ret;
  dev_t dev;

  /* config gpbcon */
  /* S3C2410_GPIO_BANKB */
  /* S3C2410_GPIO_OUTPUT */
  void *base;
  int i;
  unsigned int pin;
  unsigned int function;
  unsigned long mask;
  unsigned long con;
  unsigned long flags;

  ret = alloc_chrdev_region (&dev, 0, MYLED_COUNT, MYLED_NAME);
  if (ret < 0)
    {
      printk ("get dev error!n");
      return -1;
    }
  cdev_init (&myled_cdev, &myled_fops);
  cdev_add (&myled_cdev, dev, 1);

  myled_class = class_create (THIS_MODULE, MYLED_NAME);
  myled_device = device_create (myled_class, NULL, dev, NULL, MYLED_NAME);

  for (i = 0; i < 4; i++)
    {
      pin = led_table[i];
      function = S3C2410_GPIO_OUTPUT;
      base = S3C24XX_GPIO_BASE (pin);
      mask = 3 << S3C2410_GPIO_OFFSET (pin) * 2;
      function &= 3;
      function <<= S3C2410_GPIO_OFFSET (pin) * 2;
      local_irq_save (flags);
      con = __raw_readl (base + 0x00);
      con &= ~mask;
      con |= function;
      __raw_writel (con, base + 0x00);
      local_irq_restore (flags);

    }
  printk ("module initn");

  return ret;
}

static void __exit
myled_exit (void)
{

  dev_t dev;
  printk ("module exitn");

  dev = myled_cdev.dev;

  device_destroy (myled_class, dev);
  cdev_del (&myled_cdev);
  unregister_chrdev_region (dev, 1);
  class_destroy (myled_class);

  return;
}

module_init (myled_init);
module_exit (myled_exit);
MODULE_LICENSE ("Dual BSD/GPL");
MODULE_AUTHOR("Tsuibin");