驱动源码
- 设备树改动
在 .dts
文件中的 根节点
下添加 一级子节点
alpha_led {
#address-cells = <1>;
#size-cells = <1>;
compatible = "alientek, alphaled";
status = "okay";
reg = <
0X020C406C 0X04
0X020E0068 0X04
0X020E02F4 0X04
0X0209C000 0X04
0X0209C004 0X04
>;
};
#include<linux/module.h>
#include<linux/kernel.h>
#include<linux/init.h>
#include <linux/fs.h>
#include<linux/slab.h>
#include<linux/io.h>
#include<linux/uaccess.h>
#include<linux/cdev.h>
#include<linux/device.h>
#include<linux/of.h>
#include<linux/of_address.h>
#include<linux/of_irq.h>
#define DTSLED_NAME "dtsled"
#define LED_OFF 0
#define LED_ON 1
static void __iomem *IMX6U_CCM_CCGR1;
static void __iomem *SW_MUX_GPIO1_IO03;
static void __iomem *SW_PAD_GPIO1_IO03;
static void __iomem *GPIO1_DR;
static void __iomem *GPIO1_GDIR;
extern struct dtsled_dev dtsled;
static void led_switch(u8 state)
{
u32 val = 0;
if(state == LED_ON)
{
val = readl(GPIO1_DR);
val &= (~(1<<3));
writel(val, GPIO1_DR);
}
else if(state == LED_OFF)
{
val = readl(GPIO1_DR);
val |= (1<<3);
writel(val, GPIO1_DR);
}
}
static int dtsled_open(struct inode *inode, struct file *filp)
{
filp->private_data = &dtsled;
return 0;
}
static int dtsled_release(struct inode *inode, struct file *filp)
{
struct dtsled_dev *dev = (struct dtsled_dev *)filp->private_data;
return 0;
}
static ssize_t dtsled_write(struct file *filp, const char __user *buf, size_t count, loff_t *ppos)
{
int ret;
u8 databuf[1];
struct dtsled_dev *dev = (struct dtsled_dev *)filp->private_data;
ret = copy_from_user(databuf, buf, count);
if(ret < 0)
{
printk("Kernel write failed.\r\n");
return -1;
}
led_switch(databuf[0]);
return 0;
}
static const struct file_operations dtsled_fops =
{
.owner = THIS_MODULE,
.write = dtsled_write,
.open = dtsled_open,
.release = dtsled_release,
};
struct dtsled_dev
{
dev_t devid;
struct cdev cdev;
struct file_operations dtsled_fops;
struct class *class;
struct device *device;
u32 major;
u32 minor;
struct device_node *nd;
};
struct dtsled_dev dtsled;
static int __init dtsled_init(void)
{
int ret = 0;
int val = 0;
const char *str;
u32 regdata[10];
u8 i;
dtsled.major = 0;
if(dtsled.major)
{
dtsled.devid = MKDEV(dtsled.major, 0);
ret = register_chrdev_region(dtsled.devid, 1, DTSLED_NAME);
}
else
{
ret = alloc_chrdev_region(&dtsled.devid, 0, 1, DTSLED_NAME);
dtsled.major = MAJOR(dtsled.devid);
dtsled.minor = MINOR(dtsled.devid);
}
if(ret < 0)
{
printk("%d:Register char dev error.\r\n", __LINE__);
goto fail_devid;
}
dtsled.cdev.owner = THIS_MODULE;
cdev_init(&dtsled.cdev, &dtsled_fops);
ret = cdev_add(&dtsled.cdev, dtsled.devid, 1);
if(ret < 0)
{
goto fail_cdev;
}
dtsled.class = class_create(THIS_MODULE, DTSLED_NAME);
if(IS_ERR(dtsled.class))
{
ret = PTR_ERR(dtsled.class);
goto fail_class;
}
dtsled.device = device_create(dtsled.class, NULL, dtsled.devid, NULL, DTSLED_NAME);
if(IS_ERR(dtsled.device))
{
ret = PTR_ERR(dtsled.device);
goto fail_device;
}
dtsled.nd = of_find_node_by_path("/alpha_led");
if(dtsled.nd == NULL)
{
goto fail_findnd;
}
ret = of_property_read_string(dtsled.nd, "status", &str);
if(ret)
{
printk("%d:fail\r\n", __LINE__);
goto fail_rs;
}
else
{
printk("%d:status = \"%s\"\r\n", __LINE__, str);
}
ret = of_property_read_string(dtsled.nd, "compatible", &str);
if(ret)
{
printk("%d:fail\r\n", __LINE__);
goto fail_rs;
}
else
{
printk("%d:compatible = \"%s\"\r\n", __LINE__, str);
}
ret = of_property_read_u32_array(dtsled.nd, "reg", regdata, 10);
if(ret < 0)
{
printk("%d:fail\r\n", __LINE__);
goto fail_rs;
}
else
{
printk("< reg > = < ");
for(i=0; i<10; i++)
{
printk("%#X ", regdata[i]);
}
printk(">\r\n");
}
#if 0
IMX6U_CCM_CCGR1 = ioremap(regdata[0], regdata[1]);
SW_MUX_GPIO1_IO03 = ioremap(regdata[2], regdata[3]);
SW_PAD_GPIO1_IO03 = ioremap(regdata[4], regdata[5]);
GPIO1_DR = ioremap(regdata[6], regdata[7]);
GPIO1_GDIR = ioremap(regdata[8], regdata[9]);
#endif
IMX6U_CCM_CCGR1 = of_iomap(dtsled.nd, 0);
SW_MUX_GPIO1_IO03 = of_iomap(dtsled.nd, 1);
SW_PAD_GPIO1_IO03 = of_iomap(dtsled.nd, 2);
GPIO1_DR = of_iomap(dtsled.nd, 3);
GPIO1_GDIR = of_iomap(dtsled.nd, 4);
val = readl(IMX6U_CCM_CCGR1);
val &= (~(3<<26));
val |= (3<<26);
writel(val, IMX6U_CCM_CCGR1);
writel(0X5, SW_MUX_GPIO1_IO03);
writel(0X10B0, SW_PAD_GPIO1_IO03);
val = readl(GPIO1_GDIR);
val |= (1<<3);
writel(val, GPIO1_GDIR);
val = readl(GPIO1_DR);
val &= (~(1<<3));
writel(val, GPIO1_DR);
return 0;
fail_rs:
fail_findnd:
device_destroy(dtsled.class, dtsled.devid);
fail_device:
class_destroy(dtsled.class);
fail_class:
cdev_del(&dtsled.cdev);
fail_cdev:
unregister_chrdev_region(dtsled.devid, 1);
fail_devid:
return ret;
}
static void __exit dtsled_exit(void)
{
unsigned int val = 0;
val = readl(GPIO1_DR);
val |= (1<<3);
writel(val, GPIO1_DR);
iounmap(IMX6U_CCM_CCGR1);
iounmap(SW_MUX_GPIO1_IO03);
iounmap(SW_PAD_GPIO1_IO03);
iounmap(GPIO1_DR);
iounmap(GPIO1_GDIR);
cdev_del(&dtsled.cdev);
unregister_chrdev_region(dtsled.devid, 1);
device_destroy(dtsled.class, dtsled.devid);
class_destroy(dtsled.class);
}
module_init(dtsled_init);
module_exit(dtsled_exit);
MODULE_LICENSE("GPL");