1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161
|
#include <linux/types.h> #include <linux/kernel.h> #include <linux/delay.h> #include <linux/init.h> #include <linux/module.h> #include <linux/errno.h> #include <linux/gpio.h> #include <linux/cdev.h> #include <linux/device.h> #include <linux/of_gpio.h> #include <linux/semaphore.h> #include <linux/timer.h> #include <linux/i2c.h> #include <asm/mach/map.h> #include <asm/uaccess.h> #include <asm/io.h> #include "oled.h" #include "oled_i2c.h"
#define OLED_CNT 1 #define OLED_NAME "HCW_OLED"
static struct oled_dev oleddev;
struct file_operations oled_fops = {
};
static int oled_init(void) { oled_write_cmd(&oleddev, 0xAE); oled_write_cmd(&oleddev, 0x00); oled_write_cmd(&oleddev, 0x10); oled_write_cmd(&oleddev, 0x40); oled_write_cmd(&oleddev, 0xB0); oled_write_cmd(&oleddev, 0x81); oled_write_cmd(&oleddev, 0xFF); oled_write_cmd(&oleddev, 0xA1); oled_write_cmd(&oleddev, 0xA6); oled_write_cmd(&oleddev, 0xA8); oled_write_cmd(&oleddev, 0x3F); oled_write_cmd(&oleddev, 0xC8); oled_write_cmd(&oleddev, 0xD3); oled_write_cmd(&oleddev, 0x00); oled_write_cmd(&oleddev, 0xD5); oled_write_cmd(&oleddev, 0x80); oled_write_cmd(&oleddev, 0xD9); oled_write_cmd(&oleddev, 0xF1); oled_write_cmd(&oleddev, 0xDA); oled_write_cmd(&oleddev, 0x12); oled_write_cmd(&oleddev, 0xDB); oled_write_cmd(&oleddev, 0x40); oled_write_cmd(&oleddev, 0x8D); oled_write_cmd(&oleddev, 0x14); oled_write_cmd(&oleddev, 0xAF); printk("oled Init success!!!\r\n"); return 0; }
static int oleddev_probe(struct i2c_client *client, const struct i2c_device_id *id){ printk("matched success\r\n"); int ret = 0;
oleddev.private_data = client; msleep(500); oled_init();
oleddev.device = device_create(oleddev.class, NULL, oleddev.devid, NULL, OLED_NAME); if(IS_ERR(oleddev.device)) { return PTR_ERR(oleddev.device); }
printk("OLED%d probe success!",MINOR(oleddev.devid)); return 0; }
static void oleddev_remove(struct i2c_client *client) { device_destroy(oleddev.class, oleddev.devid); return; }
static struct of_device_id oled_drv_match_table[] = { {.compatible = "hcw,oled"}, {}, }; static struct i2c_driver oled_drv = { .probe = oleddev_probe, .remove = oleddev_remove, .driver = { .name = "OLED_DRV", .of_match_table = oled_drv_match_table, .owner = THIS_MODULE } };
static int __init oled_drv_init(void) { int ret = 0;
if(oleddev.major) { oleddev.devid = MKDEV(oleddev.major, 0); register_chrdev_region(oleddev.devid, OLED_CNT, OLED_NAME); } else { alloc_chrdev_region(&oleddev.devid, 0, OLED_CNT, OLED_NAME); oleddev.major = MAJOR(oleddev.devid); }
cdev_init(&oleddev.cdev, &oled_fops); cdev_add(&oleddev.cdev, oleddev.devid, OLED_CNT);
oleddev.class = class_create(THIS_MODULE, OLED_NAME); if(IS_ERR(oleddev.class)) { return PTR_ERR(oleddev.class); } ret = i2c_add_driver(&oled_drv);
if (ret) goto destroy_class;
return 0;
destroy_class: class_destroy(oleddev.class); cdev_del(&oleddev.cdev); unregister_chrdev_region(oleddev.devid, OLED_CNT);
return ret;
return 0; }
static void __exit oled_drv_exit(void) { i2c_del_driver(&oled_drv); unregister_chrdev_region(oleddev.devid, OLED_CNT); cdev_del(&oleddev.cdev); class_destroy(oleddev.class); }
module_init(oled_drv_init); module_exit(oled_drv_exit);
MODULE_LICENSE("GPL"); MODULE_AUTHOR("hcw");
|