18c9108d0SLars Poeschel // SPDX-License-Identifier: GPL-2.0 28c9108d0SLars Poeschel /* 38c9108d0SLars Poeschel * console driver for LCD2S 4x20 character displays connected through i2c. 48c9108d0SLars Poeschel * The display also has a spi interface, but the driver does not support 58c9108d0SLars Poeschel * this yet. 68c9108d0SLars Poeschel * 78c9108d0SLars Poeschel * This is a driver allowing you to use a LCD2S 4x20 from modtronix 88c9108d0SLars Poeschel * engineering as auxdisplay character device. 98c9108d0SLars Poeschel * 108c9108d0SLars Poeschel * (C) 2019 by Lemonage Software GmbH 118c9108d0SLars Poeschel * Author: Lars Pöschel <poeschel@lemonage.de> 128c9108d0SLars Poeschel * All rights reserved. 138c9108d0SLars Poeschel */ 148c9108d0SLars Poeschel #include <linux/kernel.h> 158c9108d0SLars Poeschel #include <linux/module.h> 168c9108d0SLars Poeschel #include <linux/slab.h> 178c9108d0SLars Poeschel #include <linux/i2c.h> 188c9108d0SLars Poeschel #include <linux/delay.h> 198c9108d0SLars Poeschel 208c9108d0SLars Poeschel #include "charlcd.h" 218c9108d0SLars Poeschel 228c9108d0SLars Poeschel #define LCD2S_CMD_CUR_MOVES_FWD 0x09 238c9108d0SLars Poeschel #define LCD2S_CMD_CUR_BLINK_OFF 0x10 248c9108d0SLars Poeschel #define LCD2S_CMD_CUR_UL_OFF 0x11 258c9108d0SLars Poeschel #define LCD2S_CMD_DISPLAY_OFF 0x12 268c9108d0SLars Poeschel #define LCD2S_CMD_CUR_BLINK_ON 0x18 278c9108d0SLars Poeschel #define LCD2S_CMD_CUR_UL_ON 0x19 288c9108d0SLars Poeschel #define LCD2S_CMD_DISPLAY_ON 0x1a 298c9108d0SLars Poeschel #define LCD2S_CMD_BACKLIGHT_OFF 0x20 308c9108d0SLars Poeschel #define LCD2S_CMD_BACKLIGHT_ON 0x28 318c9108d0SLars Poeschel #define LCD2S_CMD_WRITE 0x80 328c9108d0SLars Poeschel #define LCD2S_CMD_MOV_CUR_RIGHT 0x83 338c9108d0SLars Poeschel #define LCD2S_CMD_MOV_CUR_LEFT 0x84 348c9108d0SLars Poeschel #define LCD2S_CMD_SHIFT_RIGHT 0x85 358c9108d0SLars Poeschel #define LCD2S_CMD_SHIFT_LEFT 0x86 368c9108d0SLars Poeschel #define LCD2S_CMD_SHIFT_UP 0x87 378c9108d0SLars Poeschel #define LCD2S_CMD_SHIFT_DOWN 0x88 388c9108d0SLars Poeschel #define LCD2S_CMD_CUR_ADDR 0x89 398c9108d0SLars Poeschel #define LCD2S_CMD_CUR_POS 0x8a 408c9108d0SLars Poeschel #define LCD2S_CMD_CUR_RESET 0x8b 418c9108d0SLars Poeschel #define LCD2S_CMD_CLEAR 0x8c 428c9108d0SLars Poeschel #define LCD2S_CMD_DEF_CUSTOM_CHAR 0x92 438c9108d0SLars Poeschel #define LCD2S_CMD_READ_STATUS 0xd0 448c9108d0SLars Poeschel 458c9108d0SLars Poeschel #define LCD2S_CHARACTER_SIZE 8 468c9108d0SLars Poeschel 478c9108d0SLars Poeschel #define LCD2S_STATUS_BUF_MASK 0x7f 488c9108d0SLars Poeschel 498c9108d0SLars Poeschel struct lcd2s_data { 508c9108d0SLars Poeschel struct i2c_client *i2c; 518c9108d0SLars Poeschel struct charlcd *charlcd; 528c9108d0SLars Poeschel }; 538c9108d0SLars Poeschel 548c9108d0SLars Poeschel static s32 lcd2s_wait_buf_free(const struct i2c_client *client, int count) 558c9108d0SLars Poeschel { 568c9108d0SLars Poeschel s32 status; 578c9108d0SLars Poeschel 588c9108d0SLars Poeschel status = i2c_smbus_read_byte_data(client, LCD2S_CMD_READ_STATUS); 598c9108d0SLars Poeschel if (status < 0) 608c9108d0SLars Poeschel return status; 618c9108d0SLars Poeschel 628c9108d0SLars Poeschel while ((status & LCD2S_STATUS_BUF_MASK) < count) { 638c9108d0SLars Poeschel mdelay(1); 648c9108d0SLars Poeschel status = i2c_smbus_read_byte_data(client, 658c9108d0SLars Poeschel LCD2S_CMD_READ_STATUS); 668c9108d0SLars Poeschel if (status < 0) 678c9108d0SLars Poeschel return status; 688c9108d0SLars Poeschel } 698c9108d0SLars Poeschel return 0; 708c9108d0SLars Poeschel } 718c9108d0SLars Poeschel 728c9108d0SLars Poeschel static int lcd2s_i2c_master_send(const struct i2c_client *client, 738c9108d0SLars Poeschel const char *buf, int count) 748c9108d0SLars Poeschel { 758c9108d0SLars Poeschel s32 status; 768c9108d0SLars Poeschel 778c9108d0SLars Poeschel status = lcd2s_wait_buf_free(client, count); 788c9108d0SLars Poeschel if (status < 0) 798c9108d0SLars Poeschel return status; 808c9108d0SLars Poeschel 818c9108d0SLars Poeschel return i2c_master_send(client, buf, count); 828c9108d0SLars Poeschel } 838c9108d0SLars Poeschel 848c9108d0SLars Poeschel static int lcd2s_i2c_smbus_write_byte(const struct i2c_client *client, u8 value) 858c9108d0SLars Poeschel { 868c9108d0SLars Poeschel s32 status; 878c9108d0SLars Poeschel 888c9108d0SLars Poeschel status = lcd2s_wait_buf_free(client, 1); 898c9108d0SLars Poeschel if (status < 0) 908c9108d0SLars Poeschel return status; 918c9108d0SLars Poeschel 928c9108d0SLars Poeschel return i2c_smbus_write_byte(client, value); 938c9108d0SLars Poeschel } 948c9108d0SLars Poeschel 958c9108d0SLars Poeschel static int lcd2s_print(struct charlcd *lcd, int c) 968c9108d0SLars Poeschel { 978c9108d0SLars Poeschel struct lcd2s_data *lcd2s = lcd->drvdata; 988c9108d0SLars Poeschel u8 buf[2] = { LCD2S_CMD_WRITE, c }; 998c9108d0SLars Poeschel 1008c9108d0SLars Poeschel lcd2s_i2c_master_send(lcd2s->i2c, buf, sizeof(buf)); 1018c9108d0SLars Poeschel return 0; 1028c9108d0SLars Poeschel } 1038c9108d0SLars Poeschel 1048c9108d0SLars Poeschel static int lcd2s_gotoxy(struct charlcd *lcd, unsigned int x, unsigned int y) 1058c9108d0SLars Poeschel { 1068c9108d0SLars Poeschel struct lcd2s_data *lcd2s = lcd->drvdata; 1078c9108d0SLars Poeschel u8 buf[] = { LCD2S_CMD_CUR_POS, y + 1, x + 1}; 1088c9108d0SLars Poeschel 1098c9108d0SLars Poeschel lcd2s_i2c_master_send(lcd2s->i2c, buf, sizeof(buf)); 1108c9108d0SLars Poeschel 1118c9108d0SLars Poeschel return 0; 1128c9108d0SLars Poeschel } 1138c9108d0SLars Poeschel 1148c9108d0SLars Poeschel static int lcd2s_home(struct charlcd *lcd) 1158c9108d0SLars Poeschel { 1168c9108d0SLars Poeschel struct lcd2s_data *lcd2s = lcd->drvdata; 1178c9108d0SLars Poeschel 1188c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_CUR_RESET); 1198c9108d0SLars Poeschel return 0; 1208c9108d0SLars Poeschel } 1218c9108d0SLars Poeschel 1228c9108d0SLars Poeschel static int lcd2s_init_display(struct charlcd *lcd) 1238c9108d0SLars Poeschel { 1248c9108d0SLars Poeschel struct lcd2s_data *lcd2s = lcd->drvdata; 1258c9108d0SLars Poeschel 1268c9108d0SLars Poeschel /* turn everything off, but display on */ 1278c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_DISPLAY_ON); 1288c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_BACKLIGHT_OFF); 1298c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_CUR_MOVES_FWD); 1308c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_CUR_BLINK_OFF); 1318c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_CUR_UL_OFF); 1328c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_CLEAR); 1338c9108d0SLars Poeschel 1348c9108d0SLars Poeschel return 0; 1358c9108d0SLars Poeschel } 1368c9108d0SLars Poeschel 1378c9108d0SLars Poeschel static int lcd2s_shift_cursor(struct charlcd *lcd, enum charlcd_shift_dir dir) 1388c9108d0SLars Poeschel { 1398c9108d0SLars Poeschel struct lcd2s_data *lcd2s = lcd->drvdata; 1408c9108d0SLars Poeschel 1418c9108d0SLars Poeschel if (dir == CHARLCD_SHIFT_LEFT) 1428c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_MOV_CUR_LEFT); 1438c9108d0SLars Poeschel else 1448c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_MOV_CUR_RIGHT); 1458c9108d0SLars Poeschel 1468c9108d0SLars Poeschel return 0; 1478c9108d0SLars Poeschel } 1488c9108d0SLars Poeschel 1498c9108d0SLars Poeschel static int lcd2s_shift_display(struct charlcd *lcd, enum charlcd_shift_dir dir) 1508c9108d0SLars Poeschel { 1518c9108d0SLars Poeschel struct lcd2s_data *lcd2s = lcd->drvdata; 1528c9108d0SLars Poeschel 1538c9108d0SLars Poeschel if (dir == CHARLCD_SHIFT_LEFT) 1548c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_SHIFT_LEFT); 1558c9108d0SLars Poeschel else 1568c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_SHIFT_RIGHT); 1578c9108d0SLars Poeschel 1588c9108d0SLars Poeschel return 0; 1598c9108d0SLars Poeschel } 1608c9108d0SLars Poeschel 1618c9108d0SLars Poeschel static void lcd2s_backlight(struct charlcd *lcd, enum charlcd_onoff on) 1628c9108d0SLars Poeschel { 1638c9108d0SLars Poeschel struct lcd2s_data *lcd2s = lcd->drvdata; 1648c9108d0SLars Poeschel 1658c9108d0SLars Poeschel if (on) 1668c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_BACKLIGHT_ON); 1678c9108d0SLars Poeschel else 1688c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_BACKLIGHT_OFF); 1698c9108d0SLars Poeschel } 1708c9108d0SLars Poeschel 1718c9108d0SLars Poeschel static int lcd2s_display(struct charlcd *lcd, enum charlcd_onoff on) 1728c9108d0SLars Poeschel { 1738c9108d0SLars Poeschel struct lcd2s_data *lcd2s = lcd->drvdata; 1748c9108d0SLars Poeschel 1758c9108d0SLars Poeschel if (on) 1768c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_DISPLAY_ON); 1778c9108d0SLars Poeschel else 1788c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_DISPLAY_OFF); 1798c9108d0SLars Poeschel 1808c9108d0SLars Poeschel return 0; 1818c9108d0SLars Poeschel } 1828c9108d0SLars Poeschel 1838c9108d0SLars Poeschel static int lcd2s_cursor(struct charlcd *lcd, enum charlcd_onoff on) 1848c9108d0SLars Poeschel { 1858c9108d0SLars Poeschel struct lcd2s_data *lcd2s = lcd->drvdata; 1868c9108d0SLars Poeschel 1878c9108d0SLars Poeschel if (on) 1888c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_CUR_UL_ON); 1898c9108d0SLars Poeschel else 1908c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_CUR_UL_OFF); 1918c9108d0SLars Poeschel 1928c9108d0SLars Poeschel return 0; 1938c9108d0SLars Poeschel } 1948c9108d0SLars Poeschel 1958c9108d0SLars Poeschel static int lcd2s_blink(struct charlcd *lcd, enum charlcd_onoff on) 1968c9108d0SLars Poeschel { 1978c9108d0SLars Poeschel struct lcd2s_data *lcd2s = lcd->drvdata; 1988c9108d0SLars Poeschel 1998c9108d0SLars Poeschel if (on) 2008c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_CUR_BLINK_ON); 2018c9108d0SLars Poeschel else 2028c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_CUR_BLINK_OFF); 2038c9108d0SLars Poeschel 2048c9108d0SLars Poeschel return 0; 2058c9108d0SLars Poeschel } 2068c9108d0SLars Poeschel 2078c9108d0SLars Poeschel static int lcd2s_fontsize(struct charlcd *lcd, enum charlcd_fontsize size) 2088c9108d0SLars Poeschel { 2098c9108d0SLars Poeschel return 0; 2108c9108d0SLars Poeschel } 2118c9108d0SLars Poeschel 2128c9108d0SLars Poeschel static int lcd2s_lines(struct charlcd *lcd, enum charlcd_lines lines) 2138c9108d0SLars Poeschel { 2148c9108d0SLars Poeschel return 0; 2158c9108d0SLars Poeschel } 2168c9108d0SLars Poeschel 2178c9108d0SLars Poeschel static int lcd2s_redefine_char(struct charlcd *lcd, char *esc) 2188c9108d0SLars Poeschel { 2198c9108d0SLars Poeschel /* Generator : LGcxxxxx...xx; must have <c> between '0' 2208c9108d0SLars Poeschel * and '7', representing the numerical ASCII code of the 2218c9108d0SLars Poeschel * redefined character, and <xx...xx> a sequence of 16 2228c9108d0SLars Poeschel * hex digits representing 8 bytes for each character. 2238c9108d0SLars Poeschel * Most LCDs will only use 5 lower bits of the 7 first 2248c9108d0SLars Poeschel * bytes. 2258c9108d0SLars Poeschel */ 2268c9108d0SLars Poeschel 2278c9108d0SLars Poeschel struct lcd2s_data *lcd2s = lcd->drvdata; 2288c9108d0SLars Poeschel u8 buf[LCD2S_CHARACTER_SIZE + 2] = { LCD2S_CMD_DEF_CUSTOM_CHAR }; 2298c9108d0SLars Poeschel u8 value; 2308c9108d0SLars Poeschel int shift, i; 2318c9108d0SLars Poeschel 2328c9108d0SLars Poeschel if (!strchr(esc, ';')) 2338c9108d0SLars Poeschel return 0; 2348c9108d0SLars Poeschel 2358c9108d0SLars Poeschel esc++; 2368c9108d0SLars Poeschel 2378c9108d0SLars Poeschel buf[1] = *(esc++) - '0'; 2388c9108d0SLars Poeschel if (buf[1] > 7) 2398c9108d0SLars Poeschel return 1; 2408c9108d0SLars Poeschel 2418c9108d0SLars Poeschel i = 0; 2428c9108d0SLars Poeschel shift = 0; 2438c9108d0SLars Poeschel value = 0; 2448c9108d0SLars Poeschel while (*esc && i < LCD2S_CHARACTER_SIZE + 2) { 2458c9108d0SLars Poeschel int half; 2468c9108d0SLars Poeschel 2478c9108d0SLars Poeschel shift ^= 4; 2488c9108d0SLars Poeschel half = hex_to_bin(*esc++); 2498c9108d0SLars Poeschel if (half < 0) 2508c9108d0SLars Poeschel continue; 2518c9108d0SLars Poeschel 2528c9108d0SLars Poeschel value |= half << shift; 2538c9108d0SLars Poeschel if (shift == 0) { 2548c9108d0SLars Poeschel buf[i++] = value; 2558c9108d0SLars Poeschel value = 0; 2568c9108d0SLars Poeschel } 2578c9108d0SLars Poeschel } 2588c9108d0SLars Poeschel 2598c9108d0SLars Poeschel lcd2s_i2c_master_send(lcd2s->i2c, buf, sizeof(buf)); 2608c9108d0SLars Poeschel return 1; 2618c9108d0SLars Poeschel } 2628c9108d0SLars Poeschel 2638c9108d0SLars Poeschel static int lcd2s_clear_display(struct charlcd *lcd) 2648c9108d0SLars Poeschel { 2658c9108d0SLars Poeschel struct lcd2s_data *lcd2s = lcd->drvdata; 2668c9108d0SLars Poeschel 2678c9108d0SLars Poeschel /* This implicitly sets cursor to first row and column */ 2688c9108d0SLars Poeschel lcd2s_i2c_smbus_write_byte(lcd2s->i2c, LCD2S_CMD_CLEAR); 2698c9108d0SLars Poeschel return 0; 2708c9108d0SLars Poeschel } 2718c9108d0SLars Poeschel 2728c9108d0SLars Poeschel static const struct charlcd_ops lcd2s_ops = { 2738c9108d0SLars Poeschel .print = lcd2s_print, 2748c9108d0SLars Poeschel .backlight = lcd2s_backlight, 2758c9108d0SLars Poeschel .gotoxy = lcd2s_gotoxy, 2768c9108d0SLars Poeschel .home = lcd2s_home, 2778c9108d0SLars Poeschel .clear_display = lcd2s_clear_display, 2788c9108d0SLars Poeschel .init_display = lcd2s_init_display, 2798c9108d0SLars Poeschel .shift_cursor = lcd2s_shift_cursor, 2808c9108d0SLars Poeschel .shift_display = lcd2s_shift_display, 2818c9108d0SLars Poeschel .display = lcd2s_display, 2828c9108d0SLars Poeschel .cursor = lcd2s_cursor, 2838c9108d0SLars Poeschel .blink = lcd2s_blink, 2848c9108d0SLars Poeschel .fontsize = lcd2s_fontsize, 2858c9108d0SLars Poeschel .lines = lcd2s_lines, 2868c9108d0SLars Poeschel .redefine_char = lcd2s_redefine_char, 2878c9108d0SLars Poeschel }; 2888c9108d0SLars Poeschel 2898c9108d0SLars Poeschel static int lcd2s_i2c_probe(struct i2c_client *i2c, 2908c9108d0SLars Poeschel const struct i2c_device_id *id) 2918c9108d0SLars Poeschel { 2928c9108d0SLars Poeschel struct charlcd *lcd; 2938c9108d0SLars Poeschel struct lcd2s_data *lcd2s; 2948c9108d0SLars Poeschel int err; 2958c9108d0SLars Poeschel 2968c9108d0SLars Poeschel if (!i2c_check_functionality(i2c->adapter, 2978c9108d0SLars Poeschel I2C_FUNC_SMBUS_WRITE_BYTE_DATA | 2988c9108d0SLars Poeschel I2C_FUNC_SMBUS_WRITE_BLOCK_DATA)) 2998c9108d0SLars Poeschel return -EIO; 3008c9108d0SLars Poeschel 3018c9108d0SLars Poeschel /* Test, if the display is responding */ 3028c9108d0SLars Poeschel err = lcd2s_i2c_smbus_write_byte(i2c, LCD2S_CMD_DISPLAY_OFF); 3038c9108d0SLars Poeschel if (err < 0) 3048c9108d0SLars Poeschel return err; 3058c9108d0SLars Poeschel 3068c9108d0SLars Poeschel lcd = charlcd_alloc(); 3078c9108d0SLars Poeschel if (!lcd) 3088c9108d0SLars Poeschel return -ENOMEM; 3098c9108d0SLars Poeschel 3108c9108d0SLars Poeschel lcd2s = kzalloc(sizeof(struct lcd2s_data), GFP_KERNEL); 3118c9108d0SLars Poeschel if (!lcd2s) { 3128c9108d0SLars Poeschel err = -ENOMEM; 3138c9108d0SLars Poeschel goto fail1; 3148c9108d0SLars Poeschel } 3158c9108d0SLars Poeschel 3168c9108d0SLars Poeschel lcd->drvdata = lcd2s; 3178c9108d0SLars Poeschel lcd2s->i2c = i2c; 3188c9108d0SLars Poeschel lcd2s->charlcd = lcd; 3198c9108d0SLars Poeschel 3208c9108d0SLars Poeschel /* Required properties */ 3218c9108d0SLars Poeschel err = device_property_read_u32(&i2c->dev, "display-height-chars", 3228c9108d0SLars Poeschel &lcd->height); 3238c9108d0SLars Poeschel if (err) 3248c9108d0SLars Poeschel goto fail2; 3258c9108d0SLars Poeschel 3268c9108d0SLars Poeschel err = device_property_read_u32(&i2c->dev, "display-width-chars", 3278c9108d0SLars Poeschel &lcd->width); 3288c9108d0SLars Poeschel if (err) 3298c9108d0SLars Poeschel goto fail2; 3308c9108d0SLars Poeschel 3318c9108d0SLars Poeschel lcd->ops = &lcd2s_ops; 3328c9108d0SLars Poeschel 3338c9108d0SLars Poeschel err = charlcd_register(lcd2s->charlcd); 3348c9108d0SLars Poeschel if (err) 3358c9108d0SLars Poeschel goto fail2; 3368c9108d0SLars Poeschel 3378c9108d0SLars Poeschel i2c_set_clientdata(i2c, lcd2s); 3388c9108d0SLars Poeschel return 0; 3398c9108d0SLars Poeschel 3408c9108d0SLars Poeschel fail2: 3418c9108d0SLars Poeschel kfree(lcd2s); 3428c9108d0SLars Poeschel fail1: 3438c9108d0SLars Poeschel kfree(lcd); 3448c9108d0SLars Poeschel return err; 3458c9108d0SLars Poeschel } 3468c9108d0SLars Poeschel 3478c9108d0SLars Poeschel static int lcd2s_i2c_remove(struct i2c_client *i2c) 3488c9108d0SLars Poeschel { 3498c9108d0SLars Poeschel struct lcd2s_data *lcd2s = i2c_get_clientdata(i2c); 3508c9108d0SLars Poeschel 3518c9108d0SLars Poeschel charlcd_unregister(lcd2s->charlcd); 352*2cfd72f8SDan Carpenter kfree(lcd2s->charlcd); 3538c9108d0SLars Poeschel return 0; 3548c9108d0SLars Poeschel } 3558c9108d0SLars Poeschel 3568c9108d0SLars Poeschel static const struct i2c_device_id lcd2s_i2c_id[] = { 3578c9108d0SLars Poeschel { "lcd2s", 0 }, 3588c9108d0SLars Poeschel { } 3598c9108d0SLars Poeschel }; 3608c9108d0SLars Poeschel MODULE_DEVICE_TABLE(i2c, lcd2s_i2c_id); 3618c9108d0SLars Poeschel 3628c9108d0SLars Poeschel #ifdef CONFIG_OF 3638c9108d0SLars Poeschel static const struct of_device_id lcd2s_of_table[] = { 3648c9108d0SLars Poeschel { .compatible = "modtronix,lcd2s" }, 3658c9108d0SLars Poeschel { } 3668c9108d0SLars Poeschel }; 3678c9108d0SLars Poeschel MODULE_DEVICE_TABLE(of, lcd2s_of_table); 3688c9108d0SLars Poeschel #endif 3698c9108d0SLars Poeschel 3708c9108d0SLars Poeschel static struct i2c_driver lcd2s_i2c_driver = { 3718c9108d0SLars Poeschel .driver = { 3728c9108d0SLars Poeschel .name = "lcd2s", 3738c9108d0SLars Poeschel .owner = THIS_MODULE, 3748c9108d0SLars Poeschel #ifdef CONFIG_OF 3758c9108d0SLars Poeschel .of_match_table = of_match_ptr(lcd2s_of_table), 3768c9108d0SLars Poeschel #endif 3778c9108d0SLars Poeschel }, 3788c9108d0SLars Poeschel .probe = lcd2s_i2c_probe, 3798c9108d0SLars Poeschel .remove = lcd2s_i2c_remove, 3808c9108d0SLars Poeschel .id_table = lcd2s_i2c_id, 3818c9108d0SLars Poeschel }; 3828c9108d0SLars Poeschel 3838c9108d0SLars Poeschel static int __init lcd2s_modinit(void) 3848c9108d0SLars Poeschel { 3858c9108d0SLars Poeschel int ret = 0; 3868c9108d0SLars Poeschel 3878c9108d0SLars Poeschel ret = i2c_add_driver(&lcd2s_i2c_driver); 3888c9108d0SLars Poeschel if (ret != 0) 3898c9108d0SLars Poeschel pr_err("Failed to register lcd2s driver\n"); 3908c9108d0SLars Poeschel 3918c9108d0SLars Poeschel return ret; 3928c9108d0SLars Poeschel } 3938c9108d0SLars Poeschel module_init(lcd2s_modinit) 3948c9108d0SLars Poeschel 3958c9108d0SLars Poeschel static void __exit lcd2s_exit(void) 3968c9108d0SLars Poeschel { 3978c9108d0SLars Poeschel i2c_del_driver(&lcd2s_i2c_driver); 3988c9108d0SLars Poeschel } 3998c9108d0SLars Poeschel module_exit(lcd2s_exit) 4008c9108d0SLars Poeschel 4018c9108d0SLars Poeschel MODULE_DESCRIPTION("LCD2S character display driver"); 4028c9108d0SLars Poeschel MODULE_AUTHOR("Lars Poeschel"); 4038c9108d0SLars Poeschel MODULE_LICENSE("GPL"); 404