编译加载到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.");