| // SPDX-License-Identifier: GPL-2.0 | |
| /* | |
| * HT16K33 driver | |
| * | |
| * Author: Robin van der Gracht <robin@protonic.nl> | |
| * | |
| * Copyright: (C) 2016 Protonic Holland. | |
| * Copyright (C) 2021 Glider bv | |
| */ | |
| #include <linux/kernel.h> | |
| #include <linux/module.h> | |
| #include <linux/interrupt.h> | |
| #include <linux/i2c.h> | |
| #include <linux/property.h> | |
| #include <linux/fb.h> | |
| #include <linux/backlight.h> | |
| #include <linux/container_of.h> | |
| #include <linux/input.h> | |
| #include <linux/input/matrix_keypad.h> | |
| #include <linux/leds.h> | |
| #include <linux/workqueue.h> | |
| #include <linux/mm.h> | |
| #include <linux/map_to_7segment.h> | |
| #include <linux/map_to_14segment.h> | |
| #include <linux/unaligned.h> | |
| #include "line-display.h" | |
| /* Registers */ | |
| #define REG_SYSTEM_SETUP 0x20 | |
| #define REG_SYSTEM_SETUP_OSC_ON BIT(0) | |
| #define REG_DISPLAY_SETUP 0x80 | |
| #define REG_DISPLAY_SETUP_ON BIT(0) | |
| #define REG_DISPLAY_SETUP_BLINK_OFF (0 << 1) | |
| #define REG_DISPLAY_SETUP_BLINK_2HZ (1 << 1) | |
| #define REG_DISPLAY_SETUP_BLINK_1HZ (2 << 1) | |
| #define REG_DISPLAY_SETUP_BLINK_0HZ5 (3 << 1) | |
| #define REG_ROWINT_SET 0xA0 | |
| #define REG_ROWINT_SET_INT_EN BIT(0) | |
| #define REG_ROWINT_SET_INT_ACT_HIGH BIT(1) | |
| #define REG_BRIGHTNESS 0xE0 | |
| /* Defines */ | |
| #define DRIVER_NAME "ht16k33" | |
| #define MIN_BRIGHTNESS 0x1 | |
| #define MAX_BRIGHTNESS 0x10 | |
| #define HT16K33_MATRIX_LED_MAX_COLS 8 | |
| #define HT16K33_MATRIX_LED_MAX_ROWS 16 | |
| #define HT16K33_MATRIX_KEYPAD_MAX_COLS 3 | |
| #define HT16K33_MATRIX_KEYPAD_MAX_ROWS 12 | |
| #define BYTES_PER_ROW (HT16K33_MATRIX_LED_MAX_ROWS / 8) | |
| #define HT16K33_FB_SIZE (HT16K33_MATRIX_LED_MAX_COLS * BYTES_PER_ROW) | |
| enum display_type { | |
| DISP_MATRIX = 0, | |
| DISP_QUAD_7SEG, | |
| DISP_QUAD_14SEG, | |
| }; | |
| struct ht16k33_keypad { | |
| struct i2c_client *client; | |
| struct input_dev *dev; | |
| uint32_t cols; | |
| uint32_t rows; | |
| uint32_t row_shift; | |
| uint32_t debounce_ms; | |
| uint16_t last_key_state[HT16K33_MATRIX_KEYPAD_MAX_COLS]; | |
| wait_queue_head_t wait; | |
| bool stopped; | |
| }; | |
| struct ht16k33_fbdev { | |
| struct fb_info *info; | |
| uint32_t refresh_rate; | |
| uint8_t *buffer; | |
| uint8_t *cache; | |
| }; | |
| struct ht16k33_priv { | |
| struct i2c_client *client; | |
| struct delayed_work work; | |
| struct led_classdev led; | |
| struct ht16k33_keypad keypad; | |
| union { | |
| struct ht16k33_fbdev fbdev; | |
| struct linedisp linedisp; | |
| }; | |
| enum display_type type; | |
| uint8_t blink; | |
| }; | |
| #define ht16k33_work_to_priv(p) \ | |
| container_of(p, struct ht16k33_priv, work.work) | |
| #define ht16k33_led_to_priv(p) \ | |
| container_of(p, struct ht16k33_priv, led) | |
| #define ht16k33_linedisp_to_priv(p) \ | |
| container_of(p, struct ht16k33_priv, linedisp) | |
| static const struct fb_fix_screeninfo ht16k33_fb_fix = { | |
| .id = DRIVER_NAME, | |
| .type = FB_TYPE_PACKED_PIXELS, | |
| .visual = FB_VISUAL_MONO10, | |
| .xpanstep = 0, | |
| .ypanstep = 0, | |
| .ywrapstep = 0, | |
| .line_length = HT16K33_MATRIX_LED_MAX_ROWS, | |
| .accel = FB_ACCEL_NONE, | |
| }; | |
| static const struct fb_var_screeninfo ht16k33_fb_var = { | |
| .xres = HT16K33_MATRIX_LED_MAX_ROWS, | |
| .yres = HT16K33_MATRIX_LED_MAX_COLS, | |
| .xres_virtual = HT16K33_MATRIX_LED_MAX_ROWS, | |
| .yres_virtual = HT16K33_MATRIX_LED_MAX_COLS, | |
| .bits_per_pixel = 1, | |
| .red = { 0, 1, 0 }, | |
| .green = { 0, 1, 0 }, | |
| .blue = { 0, 1, 0 }, | |
| .left_margin = 0, | |
| .right_margin = 0, | |
| .upper_margin = 0, | |
| .lower_margin = 0, | |
| .vmode = FB_VMODE_NONINTERLACED, | |
| }; | |
| static int ht16k33_display_on(struct ht16k33_priv *priv) | |
| { | |
| uint8_t data = REG_DISPLAY_SETUP | REG_DISPLAY_SETUP_ON | priv->blink; | |
| return i2c_smbus_write_byte(priv->client, data); | |
| } | |
| static int ht16k33_display_off(struct ht16k33_priv *priv) | |
| { | |
| return i2c_smbus_write_byte(priv->client, REG_DISPLAY_SETUP); | |
| } | |
| static int ht16k33_brightness_set(struct ht16k33_priv *priv, | |
| unsigned int brightness) | |
| { | |
| int err; | |
| if (brightness == 0) { | |
| priv->blink = REG_DISPLAY_SETUP_BLINK_OFF; | |
| return ht16k33_display_off(priv); | |
| } | |
| err = ht16k33_display_on(priv); | |
| if (err) | |
| return err; | |
| return i2c_smbus_write_byte(priv->client, | |
| REG_BRIGHTNESS | (brightness - 1)); | |
| } | |
| static int ht16k33_brightness_set_blocking(struct led_classdev *led_cdev, | |
| enum led_brightness brightness) | |
| { | |
| struct ht16k33_priv *priv = ht16k33_led_to_priv(led_cdev); | |
| return ht16k33_brightness_set(priv, brightness); | |
| } | |
| static int ht16k33_blink_set(struct led_classdev *led_cdev, | |
| unsigned long *delay_on, unsigned long *delay_off) | |
| { | |
| struct ht16k33_priv *priv = ht16k33_led_to_priv(led_cdev); | |
| unsigned int delay; | |
| uint8_t blink; | |
| int err; | |
| if (!*delay_on && !*delay_off) { | |
| blink = REG_DISPLAY_SETUP_BLINK_1HZ; | |
| delay = 1000; | |
| } else if (*delay_on <= 750) { | |
| blink = REG_DISPLAY_SETUP_BLINK_2HZ; | |
| delay = 500; | |
| } else if (*delay_on <= 1500) { | |
| blink = REG_DISPLAY_SETUP_BLINK_1HZ; | |
| delay = 1000; | |
| } else { | |
| blink = REG_DISPLAY_SETUP_BLINK_0HZ5; | |
| delay = 2000; | |
| } | |
| err = i2c_smbus_write_byte(priv->client, | |
| REG_DISPLAY_SETUP | REG_DISPLAY_SETUP_ON | | |
| blink); | |
| if (err) | |
| return err; | |
| priv->blink = blink; | |
| *delay_on = *delay_off = delay; | |
| return 0; | |
| } | |
| static void ht16k33_fb_queue(struct ht16k33_priv *priv) | |
| { | |
| struct ht16k33_fbdev *fbdev = &priv->fbdev; | |
| schedule_delayed_work(&priv->work, HZ / fbdev->refresh_rate); | |
| } | |
| /* | |
| * This gets the fb data from cache and copies it to ht16k33 display RAM | |
| */ | |
| static void ht16k33_fb_update(struct work_struct *work) | |
| { | |
| struct ht16k33_priv *priv = ht16k33_work_to_priv(work); | |
| struct ht16k33_fbdev *fbdev = &priv->fbdev; | |
| uint8_t *p1, *p2; | |
| int len, pos = 0, first = -1; | |
| p1 = fbdev->cache; | |
| p2 = fbdev->buffer; | |
| /* Search for the first byte with changes */ | |
| while (pos < HT16K33_FB_SIZE && first < 0) { | |
| if (*(p1++) - *(p2++)) | |
| first = pos; | |
| pos++; | |
| } | |
| /* No changes found */ | |
| if (first < 0) | |
| goto requeue; | |
| len = HT16K33_FB_SIZE - first; | |
| p1 = fbdev->cache + HT16K33_FB_SIZE - 1; | |
| p2 = fbdev->buffer + HT16K33_FB_SIZE - 1; | |
| /* Determine i2c transfer length */ | |
| while (len > 1) { | |
| if (*(p1--) - *(p2--)) | |
| break; | |
| len--; | |
| } | |
| p1 = fbdev->cache + first; | |
| p2 = fbdev->buffer + first; | |
| if (!i2c_smbus_write_i2c_block_data(priv->client, first, len, p2)) | |
| memcpy(p1, p2, len); | |
| requeue: | |
| ht16k33_fb_queue(priv); | |
| } | |
| static int ht16k33_initialize(struct ht16k33_priv *priv) | |
| { | |
| uint8_t data[HT16K33_FB_SIZE]; | |
| uint8_t byte; | |
| int err; | |
| /* Clear RAM (8 * 16 bits) */ | |
| memset(data, 0, sizeof(data)); | |
| err = i2c_smbus_write_block_data(priv->client, 0, sizeof(data), data); | |
| if (err) | |
| return err; | |
| /* Turn on internal oscillator */ | |
| byte = REG_SYSTEM_SETUP_OSC_ON | REG_SYSTEM_SETUP; | |
| err = i2c_smbus_write_byte(priv->client, byte); | |
| if (err) | |
| return err; | |
| /* Configure INT pin */ | |
| byte = REG_ROWINT_SET | REG_ROWINT_SET_INT_ACT_HIGH; | |
| if (priv->client->irq > 0) | |
| byte |= REG_ROWINT_SET_INT_EN; | |
| return i2c_smbus_write_byte(priv->client, byte); | |
| } | |
| static int ht16k33_bl_update_status(struct backlight_device *bl) | |
| { | |
| const int brightness = backlight_get_brightness(bl); | |
| struct ht16k33_priv *priv = bl_get_data(bl); | |
| return ht16k33_brightness_set(priv, brightness); | |
| } | |
| static const struct backlight_ops ht16k33_bl_ops = { | |
| .update_status = ht16k33_bl_update_status, | |
| }; | |
| /* | |
| * Blank events will be passed to the actual device handling the backlight when | |
| * we return zero here. | |
| */ | |
| static int ht16k33_blank(int blank, struct fb_info *info) | |
| { | |
| return 0; | |
| } | |
| static int ht16k33_mmap(struct fb_info *info, struct vm_area_struct *vma) | |
| { | |
| struct ht16k33_priv *priv = info->par; | |
| struct page *pages = virt_to_page(priv->fbdev.buffer); | |
| vma->vm_page_prot = pgprot_decrypted(vma->vm_page_prot); | |
| return vm_map_pages_zero(vma, &pages, 1); | |
| } | |
| static const struct fb_ops ht16k33_fb_ops = { | |
| .owner = THIS_MODULE, | |
| __FB_DEFAULT_SYSMEM_OPS_RDWR, | |
| .fb_blank = ht16k33_blank, | |
| __FB_DEFAULT_SYSMEM_OPS_DRAW, | |
| .fb_mmap = ht16k33_mmap, | |
| }; | |
| /* | |
| * This gets the keys from keypad and reports it to input subsystem. | |
| * Returns true if a key is pressed. | |
| */ | |
| static bool ht16k33_keypad_scan(struct ht16k33_keypad *keypad) | |
| { | |
| const unsigned short *keycodes = keypad->dev->keycode; | |
| u16 new_state[HT16K33_MATRIX_KEYPAD_MAX_COLS]; | |
| __le16 data[HT16K33_MATRIX_KEYPAD_MAX_COLS]; | |
| unsigned long bits_changed; | |
| int row, col, code; | |
| int rc; | |
| bool pressed = false; | |
| rc = i2c_smbus_read_i2c_block_data(keypad->client, 0x40, | |
| sizeof(data), (u8 *)data); | |
| if (rc != sizeof(data)) { | |
| dev_err(&keypad->client->dev, | |
| "Failed to read key data, rc=%d\n", rc); | |
| return false; | |
| } | |
| for (col = 0; col < keypad->cols; col++) { | |
| new_state[col] = le16_to_cpu(data[col]); | |
| if (new_state[col]) | |
| pressed = true; | |
| bits_changed = keypad->last_key_state[col] ^ new_state[col]; | |
| for_each_set_bit(row, &bits_changed, BITS_PER_LONG) { | |
| code = MATRIX_SCAN_CODE(row, col, keypad->row_shift); | |
| input_event(keypad->dev, EV_MSC, MSC_SCAN, code); | |
| input_report_key(keypad->dev, keycodes[code], | |
| new_state[col] & BIT(row)); | |
| } | |
| } | |
| input_sync(keypad->dev); | |
| memcpy(keypad->last_key_state, new_state, sizeof(u16) * keypad->cols); | |
| return pressed; | |
| } | |
| static irqreturn_t ht16k33_keypad_irq_thread(int irq, void *dev) | |
| { | |
| struct ht16k33_keypad *keypad = dev; | |
| do { | |
| wait_event_timeout(keypad->wait, keypad->stopped, | |
| msecs_to_jiffies(keypad->debounce_ms)); | |
| if (keypad->stopped) | |
| break; | |
| } while (ht16k33_keypad_scan(keypad)); | |
| return IRQ_HANDLED; | |
| } | |
| static int ht16k33_keypad_start(struct input_dev *dev) | |
| { | |
| struct ht16k33_keypad *keypad = input_get_drvdata(dev); | |
| keypad->stopped = false; | |
| mb(); | |
| enable_irq(keypad->client->irq); | |
| return 0; | |
| } | |
| static void ht16k33_keypad_stop(struct input_dev *dev) | |
| { | |
| struct ht16k33_keypad *keypad = input_get_drvdata(dev); | |
| keypad->stopped = true; | |
| mb(); | |
| wake_up(&keypad->wait); | |
| disable_irq(keypad->client->irq); | |
| } | |
| static void ht16k33_seg7_update(struct work_struct *work) | |
| { | |
| struct ht16k33_priv *priv = ht16k33_work_to_priv(work); | |
| struct linedisp_map *map = priv->linedisp.map; | |
| char *s = priv->linedisp.buf; | |
| uint8_t buf[9]; | |
| buf[0] = map_to_seg7(&map->map.seg7, *s++); | |
| buf[1] = 0; | |
| buf[2] = map_to_seg7(&map->map.seg7, *s++); | |
| buf[3] = 0; | |
| buf[4] = 0; | |
| buf[5] = 0; | |
| buf[6] = map_to_seg7(&map->map.seg7, *s++); | |
| buf[7] = 0; | |
| buf[8] = map_to_seg7(&map->map.seg7, *s++); | |
| i2c_smbus_write_i2c_block_data(priv->client, 0, ARRAY_SIZE(buf), buf); | |
| } | |
| static void ht16k33_seg14_update(struct work_struct *work) | |
| { | |
| struct ht16k33_priv *priv = ht16k33_work_to_priv(work); | |
| struct linedisp_map *map = priv->linedisp.map; | |
| char *s = priv->linedisp.buf; | |
| uint8_t buf[8]; | |
| put_unaligned_le16(map_to_seg14(&map->map.seg14, *s++), buf + 0); | |
| put_unaligned_le16(map_to_seg14(&map->map.seg14, *s++), buf + 2); | |
| put_unaligned_le16(map_to_seg14(&map->map.seg14, *s++), buf + 4); | |
| put_unaligned_le16(map_to_seg14(&map->map.seg14, *s++), buf + 6); | |
| i2c_smbus_write_i2c_block_data(priv->client, 0, ARRAY_SIZE(buf), buf); | |
| } | |
| static int ht16k33_linedisp_get_map_type(struct linedisp *linedisp) | |
| { | |
| struct ht16k33_priv *priv = ht16k33_linedisp_to_priv(linedisp); | |
| switch (priv->type) { | |
| case DISP_QUAD_7SEG: | |
| INIT_DELAYED_WORK(&priv->work, ht16k33_seg7_update); | |
| return LINEDISP_MAP_SEG7; | |
| case DISP_QUAD_14SEG: | |
| INIT_DELAYED_WORK(&priv->work, ht16k33_seg14_update); | |
| return LINEDISP_MAP_SEG14; | |
| default: | |
| return -EINVAL; | |
| } | |
| } | |
| static void ht16k33_linedisp_update(struct linedisp *linedisp) | |
| { | |
| struct ht16k33_priv *priv = ht16k33_linedisp_to_priv(linedisp); | |
| schedule_delayed_work(&priv->work, 0); | |
| } | |
| static const struct linedisp_ops ht16k33_linedisp_ops = { | |
| .get_map_type = ht16k33_linedisp_get_map_type, | |
| .update = ht16k33_linedisp_update, | |
| }; | |
| static int ht16k33_led_probe(struct device *dev, struct led_classdev *led, | |
| unsigned int brightness) | |
| { | |
| struct led_init_data init_data = {}; | |
| int err; | |
| /* The LED is optional */ | |
| init_data.fwnode = device_get_named_child_node(dev, "led"); | |
| if (!init_data.fwnode) | |
| return 0; | |
| init_data.devicename = "auxdisplay"; | |
| init_data.devname_mandatory = true; | |
| led->brightness_set_blocking = ht16k33_brightness_set_blocking; | |
| led->blink_set = ht16k33_blink_set; | |
| led->flags = LED_CORE_SUSPENDRESUME; | |
| led->brightness = brightness; | |
| led->max_brightness = MAX_BRIGHTNESS; | |
| err = devm_led_classdev_register_ext(dev, led, &init_data); | |
| fwnode_handle_put(init_data.fwnode); | |
| if (err) | |
| dev_err(dev, "Failed to register LED\n"); | |
| return err; | |
| } | |
| static int ht16k33_keypad_probe(struct i2c_client *client, | |
| struct ht16k33_keypad *keypad) | |
| { | |
| struct device *dev = &client->dev; | |
| u32 rows = HT16K33_MATRIX_KEYPAD_MAX_ROWS; | |
| u32 cols = HT16K33_MATRIX_KEYPAD_MAX_COLS; | |
| int err; | |
| keypad->client = client; | |
| init_waitqueue_head(&keypad->wait); | |
| keypad->dev = devm_input_allocate_device(dev); | |
| if (!keypad->dev) | |
| return -ENOMEM; | |
| input_set_drvdata(keypad->dev, keypad); | |
| keypad->dev->name = DRIVER_NAME"-keypad"; | |
| keypad->dev->id.bustype = BUS_I2C; | |
| keypad->dev->open = ht16k33_keypad_start; | |
| keypad->dev->close = ht16k33_keypad_stop; | |
| if (!device_property_read_bool(dev, "linux,no-autorepeat")) | |
| __set_bit(EV_REP, keypad->dev->evbit); | |
| err = device_property_read_u32(dev, "debounce-delay-ms", | |
| &keypad->debounce_ms); | |
| if (err) { | |
| dev_err(dev, "key debounce delay not specified\n"); | |
| return err; | |
| } | |
| err = matrix_keypad_parse_properties(dev, &rows, &cols); | |
| if (err) | |
| return err; | |
| if (rows > HT16K33_MATRIX_KEYPAD_MAX_ROWS || | |
| cols > HT16K33_MATRIX_KEYPAD_MAX_COLS) { | |
| dev_err(dev, "%u rows or %u cols out of range in DT\n", rows, | |
| cols); | |
| return -ERANGE; | |
| } | |
| keypad->rows = rows; | |
| keypad->cols = cols; | |
| keypad->row_shift = get_count_order(cols); | |
| err = matrix_keypad_build_keymap(NULL, NULL, rows, cols, NULL, | |
| keypad->dev); | |
| if (err) { | |
| dev_err(dev, "failed to build keymap\n"); | |
| return err; | |
| } | |
| err = devm_request_threaded_irq(dev, client->irq, NULL, | |
| ht16k33_keypad_irq_thread, | |
| IRQF_TRIGGER_HIGH | IRQF_ONESHOT, | |
| DRIVER_NAME, keypad); | |
| if (err) { | |
| dev_err(dev, "irq request failed %d, error %d\n", client->irq, | |
| err); | |
| return err; | |
| } | |
| ht16k33_keypad_stop(keypad->dev); | |
| return input_register_device(keypad->dev); | |
| } | |
| static int ht16k33_fbdev_probe(struct device *dev, struct ht16k33_priv *priv, | |
| uint32_t brightness) | |
| { | |
| struct ht16k33_fbdev *fbdev = &priv->fbdev; | |
| struct backlight_device *bl = NULL; | |
| int err; | |
| if (priv->led.dev) { | |
| err = ht16k33_brightness_set(priv, brightness); | |
| if (err) | |
| return err; | |
| } else { | |
| /* backwards compatibility with DT lacking an led subnode */ | |
| struct backlight_properties bl_props; | |
| memset(&bl_props, 0, sizeof(struct backlight_properties)); | |
| bl_props.type = BACKLIGHT_RAW; | |
| bl_props.max_brightness = MAX_BRIGHTNESS; | |
| bl = devm_backlight_device_register(dev, DRIVER_NAME"-bl", dev, | |
| priv, &ht16k33_bl_ops, | |
| &bl_props); | |
| if (IS_ERR(bl)) { | |
| dev_err(dev, "failed to register backlight\n"); | |
| return PTR_ERR(bl); | |
| } | |
| bl->props.brightness = brightness; | |
| ht16k33_bl_update_status(bl); | |
| } | |
| /* Framebuffer (2 bytes per column) */ | |
| BUILD_BUG_ON(PAGE_SIZE < HT16K33_FB_SIZE); | |
| fbdev->buffer = (unsigned char *) get_zeroed_page(GFP_KERNEL); | |
| if (!fbdev->buffer) | |
| return -ENOMEM; | |
| fbdev->cache = devm_kmalloc(dev, HT16K33_FB_SIZE, GFP_KERNEL); | |
| if (!fbdev->cache) { | |
| err = -ENOMEM; | |
| goto err_fbdev_buffer; | |
| } | |
| fbdev->info = framebuffer_alloc(0, dev); | |
| if (!fbdev->info) { | |
| err = -ENOMEM; | |
| goto err_fbdev_buffer; | |
| } | |
| err = device_property_read_u32(dev, "refresh-rate-hz", | |
| &fbdev->refresh_rate); | |
| if (err) { | |
| dev_err(dev, "refresh rate not specified\n"); | |
| goto err_fbdev_info; | |
| } | |
| fb_bl_default_curve(fbdev->info, 0, MIN_BRIGHTNESS, MAX_BRIGHTNESS); | |
| INIT_DELAYED_WORK(&priv->work, ht16k33_fb_update); | |
| fbdev->info->fbops = &ht16k33_fb_ops; | |
| fbdev->info->flags |= FBINFO_VIRTFB; | |
| fbdev->info->screen_buffer = fbdev->buffer; | |
| fbdev->info->screen_size = HT16K33_FB_SIZE; | |
| fbdev->info->fix = ht16k33_fb_fix; | |
| fbdev->info->var = ht16k33_fb_var; | |
| fbdev->info->bl_dev = bl; | |
| fbdev->info->pseudo_palette = NULL; | |
| fbdev->info->par = priv; | |
| err = register_framebuffer(fbdev->info); | |
| if (err) | |
| goto err_fbdev_info; | |
| ht16k33_fb_queue(priv); | |
| return 0; | |
| err_fbdev_info: | |
| framebuffer_release(fbdev->info); | |
| err_fbdev_buffer: | |
| free_page((unsigned long) fbdev->buffer); | |
| return err; | |
| } | |
| static int ht16k33_seg_probe(struct device *dev, struct ht16k33_priv *priv, | |
| uint32_t brightness) | |
| { | |
| struct linedisp *linedisp = &priv->linedisp; | |
| int err; | |
| err = ht16k33_brightness_set(priv, brightness); | |
| if (err) | |
| return err; | |
| return linedisp_register(linedisp, dev, 4, &ht16k33_linedisp_ops); | |
| } | |
| static int ht16k33_probe(struct i2c_client *client) | |
| { | |
| struct device *dev = &client->dev; | |
| struct ht16k33_priv *priv; | |
| uint32_t dft_brightness; | |
| int err; | |
| if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) { | |
| dev_err(dev, "i2c_check_functionality error\n"); | |
| return -EIO; | |
| } | |
| priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); | |
| if (!priv) | |
| return -ENOMEM; | |
| priv->client = client; | |
| priv->type = (uintptr_t)i2c_get_match_data(client); | |
| i2c_set_clientdata(client, priv); | |
| err = ht16k33_initialize(priv); | |
| if (err) | |
| return err; | |
| err = device_property_read_u32(dev, "default-brightness-level", | |
| &dft_brightness); | |
| if (err) { | |
| dft_brightness = MAX_BRIGHTNESS; | |
| } else if (dft_brightness > MAX_BRIGHTNESS) { | |
| dev_warn(dev, | |
| "invalid default brightness level: %u, using %u\n", | |
| dft_brightness, MAX_BRIGHTNESS); | |
| dft_brightness = MAX_BRIGHTNESS; | |
| } | |
| /* LED */ | |
| err = ht16k33_led_probe(dev, &priv->led, dft_brightness); | |
| if (err) | |
| return err; | |
| /* Keypad */ | |
| if (client->irq > 0) { | |
| err = ht16k33_keypad_probe(client, &priv->keypad); | |
| if (err) | |
| return err; | |
| } | |
| switch (priv->type) { | |
| case DISP_MATRIX: | |
| /* Frame Buffer Display */ | |
| err = ht16k33_fbdev_probe(dev, priv, dft_brightness); | |
| break; | |
| case DISP_QUAD_7SEG: | |
| case DISP_QUAD_14SEG: | |
| /* Segment Display */ | |
| err = ht16k33_seg_probe(dev, priv, dft_brightness); | |
| break; | |
| default: | |
| return -EINVAL; | |
| } | |
| return err; | |
| } | |
| static void ht16k33_remove(struct i2c_client *client) | |
| { | |
| struct ht16k33_priv *priv = i2c_get_clientdata(client); | |
| struct ht16k33_fbdev *fbdev = &priv->fbdev; | |
| cancel_delayed_work_sync(&priv->work); | |
| switch (priv->type) { | |
| case DISP_MATRIX: | |
| unregister_framebuffer(fbdev->info); | |
| framebuffer_release(fbdev->info); | |
| free_page((unsigned long)fbdev->buffer); | |
| break; | |
| case DISP_QUAD_7SEG: | |
| case DISP_QUAD_14SEG: | |
| linedisp_unregister(&priv->linedisp); | |
| break; | |
| default: | |
| break; | |
| } | |
| } | |
| static const struct i2c_device_id ht16k33_i2c_match[] = { | |
| { "3108", DISP_QUAD_7SEG }, | |
| { "3130", DISP_QUAD_14SEG }, | |
| { "ht16k33", DISP_MATRIX }, | |
| { } | |
| }; | |
| MODULE_DEVICE_TABLE(i2c, ht16k33_i2c_match); | |
| static const struct of_device_id ht16k33_of_match[] = { | |
| { | |
| /* 0.56" 4-Digit 7-Segment FeatherWing Display (Red) */ | |
| .compatible = "adafruit,3108", .data = (void *)DISP_QUAD_7SEG, | |
| }, { | |
| /* 0.54" Quad Alphanumeric FeatherWing Display (Red) */ | |
| .compatible = "adafruit,3130", .data = (void *)DISP_QUAD_14SEG, | |
| }, { | |
| /* Generic, assumed Dot-Matrix Display */ | |
| .compatible = "holtek,ht16k33", .data = (void *)DISP_MATRIX, | |
| }, | |
| { } | |
| }; | |
| MODULE_DEVICE_TABLE(of, ht16k33_of_match); | |
| static struct i2c_driver ht16k33_driver = { | |
| .probe = ht16k33_probe, | |
| .remove = ht16k33_remove, | |
| .driver = { | |
| .name = DRIVER_NAME, | |
| .of_match_table = ht16k33_of_match, | |
| }, | |
| .id_table = ht16k33_i2c_match, | |
| }; | |
| module_i2c_driver(ht16k33_driver); | |
| MODULE_DESCRIPTION("Holtek HT16K33 driver"); | |
| MODULE_LICENSE("GPL"); | |
| MODULE_IMPORT_NS("LINEDISP"); | |
| MODULE_AUTHOR("Robin van der Gracht <robin@protonic.nl>"); |