主题 : INSMOD后端口没有变化 复制链接 | 浏览器收藏 | 打印
级别: 新手上路
UID: 60664
精华: 0
发帖: 13
金钱: 65 两
威望: 13 点
综合积分: 26 分
注册时间: 2011-12-14
最后登录: 2017-09-13
楼主  发表于: 2011-12-14 13:01

 INSMOD后端口没有变化

编译加载到TINY6410 LINUX内核中去后端口无变化,麻烦看看到底是什么原因
#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 <plat/gpio-cfg.h>
#include <mach/gpio-bank-e.h>
#include <mach/gpio-bank-k.h>

#define S3C64XX_GPMCON   (S3C64XX_GPM_BASE + 0x00)
#define S3C64XX_GPMDAT   (S3C64XX_GPM_BASE + 0x04)

#define DEVICE_NAME "leds1"
static long sbc2440_leds_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
{
 switch(cmd) {
  unsigned tmp;
 case 0:
  if (arg > 8) {
   return -EINVAL;
  }
         switch(arg) {
          case 0:
       tmp = readl(S3C64XX_GPEDAT);
       tmp |= (1 << 1);
       writel(tmp, S3C64XX_GPEDAT);
       return 0;
          case 1:
       tmp = readl(S3C64XX_GPEDAT);
       tmp |= (1 << 2);
       writel(tmp, S3C64XX_GPEDAT);
       return 0;
          case 2:
       tmp = readl(S3C64XX_GPEDAT);
       tmp |= (1 << 3);
       writel(tmp, S3C64XX_GPEDAT);
       return 0;
          case 3:
       tmp = readl(S3C64XX_GPEDAT);
       tmp |= (1 << 4);
       writel(tmp, S3C64XX_GPEDAT);
       return 0;
          case 4:
       tmp = readl(S3C64XX_GPMDAT);
       tmp |= (1 << 0);
       writel(tmp, S3C64XX_GPMDAT);
       return 0;
          case 5:
       tmp = readl(S3C64XX_GPMDAT);
       tmp |= (1 << 1);
       writel(tmp, S3C64XX_GPMDAT);
       return 0;
          case 6:
       tmp = readl(S3C64XX_GPMDAT);
       tmp |= (1 << 2);
       writel(tmp, S3C64XX_GPMDAT);
       return 0;
          case 7:
       tmp = readl(S3C64XX_GPMDAT);
       tmp |= (1 << 4);
       writel(tmp, S3C64XX_GPMDAT);
       return 0;
          default:
       return -EINVAL;
         }       
  //printk (DEVICE_NAME": %d %d\n", arg, cmd);
 case 1:
  if (arg > 8) {
   return -EINVAL;
  }
         switch(arg) {
          case 0:
       tmp = readl(S3C64XX_GPEDAT);
       tmp &= ~(1 << 1);
       tmp |= ( (!cmd) << 1 );
       writel(tmp, S3C64XX_GPEDAT);
       return 0;
          case 1:
       tmp = readl(S3C64XX_GPEDAT);
       tmp &= ~(1 << 2);
       tmp |= ( (!cmd) << 2 );
       writel(tmp, S3C64XX_GPEDAT);
       return 0;
          case 2:
       tmp = readl(S3C64XX_GPEDAT);
       tmp &= ~(1 << 3);
       tmp |= ( (!cmd) << 3 );
       writel(tmp, S3C64XX_GPEDAT);
       return 0;
          case 3:
       tmp = readl(S3C64XX_GPEDAT);
       tmp &= ~(1 << 4);
       tmp |= ( (!cmd) << 4 );
       writel(tmp, S3C64XX_GPEDAT);
       return 0;
          case 4:
       tmp = readl(S3C64XX_GPMDAT);
       tmp &= ~(1 << 0);
       tmp |= ( (!cmd) << 0 );
       writel(tmp, S3C64XX_GPMDAT);
       return 0;
          case 5:
       tmp = readl(S3C64XX_GPMDAT);
       tmp &= ~(1 << 1);
       tmp |= ( (!cmd) << 1 );
       writel(tmp, S3C64XX_GPMDAT);
       return 0;
          case 6:
       tmp = readl(S3C64XX_GPMDAT);
       tmp &= ~(1 << 2);
       tmp |= ( (!cmd) << 2 );
       writel(tmp, S3C64XX_GPMDAT);
       return 0;
          case 7:
       tmp = readl(S3C64XX_GPMDAT);
       tmp &= ~(1 << 3);
       tmp |= ( (!cmd) << 3 );
       writel(tmp, S3C64XX_GPMDAT);
       return 0;
          default:
       return -EINVAL;
         }       
  //printk (DEVICE_NAME": %d %d\n", arg, cmd);
 default:
  return -EINVAL;
 }
}
static struct file_operations dev_fops = {
 .owner   = THIS_MODULE,
 .unlocked_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;
 {
  unsigned tmp;
  tmp = readl(S3C64XX_GPECON);
  tmp = (tmp & ~(0xffffU<<4))|(0x1111U<<4);
  writel(tmp, S3C64XX_GPECON);
  
  tmp = readl(S3C64XX_GPEDAT);
  tmp |= (0xF << 1);
  writel(tmp, S3C64XX_GPEDAT);
  tmp = readl(S3C64XX_GPMCON);
  tmp = (tmp & ~(0xffffU<<0))|(0x1111U<<0);
  writel(tmp, S3C64XX_GPMCON);
  
  tmp = readl(S3C64XX_GPMDAT);
  tmp |= (0xF << 0);
  writel(tmp, S3C64XX_GPMDAT);
 }
 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("FriendlyARM Inc.");