mirror of
https://github.com/LibreELEC/LibreELEC.tv
synced 2025-09-24 19:46:01 +07:00
420 lines
11 KiB
Diff
420 lines
11 KiB
Diff
From 1dbdfd4092b51f693c7055c8fea169369db96f8f Mon Sep 17 00:00:00 2001
|
|
From: =?UTF-8?q?Jean-Fran=C3=A7ois=20Lessard?= <jefflessard3@gmail.com>
|
|
Date: Sat, 23 Aug 2025 21:26:59 -0400
|
|
Subject: [PATCH 50/54] TEST: auxdisplay: TM16xx: Add support for I2C-based
|
|
controllers
|
|
MIME-Version: 1.0
|
|
Content-Type: text/plain; charset=UTF-8
|
|
Content-Transfer-Encoding: 8bit
|
|
|
|
Add support for TM16xx-compatible auxiliary display controllers connected
|
|
via the I2C bus.
|
|
|
|
The implementation includes:
|
|
- I2C driver registration and initialization
|
|
- Probe/remove logic for I2C devices
|
|
- Controller-specific handling and communication sequences
|
|
- Integration with the TM16xx core driver for common functionality
|
|
|
|
This allows platforms using TM16xx or compatible controllers over I2C to be
|
|
managed by the TM16xx driver infrastructure.
|
|
|
|
Signed-off-by: Jean-François Lessard <jefflessard3@gmail.com>
|
|
---
|
|
MAINTAINERS | 1 +
|
|
drivers/auxdisplay/Kconfig | 16 ++
|
|
drivers/auxdisplay/Makefile | 1 +
|
|
drivers/auxdisplay/tm16xx_i2c.c | 332 ++++++++++++++++++++++++++++++++
|
|
4 files changed, 350 insertions(+)
|
|
create mode 100644 drivers/auxdisplay/tm16xx_i2c.c
|
|
|
|
diff --git a/MAINTAINERS b/MAINTAINERS
|
|
index a5b66317a805..f1354b5c9bd7 100644
|
|
--- a/MAINTAINERS
|
|
+++ b/MAINTAINERS
|
|
@@ -25050,6 +25050,7 @@ F: Documentation/ABI/testing/sysfs-class-leds-tm16xx
|
|
F: Documentation/devicetree/bindings/auxdisplay/titanmec,tm16xx.yaml
|
|
F: drivers/auxdisplay/tm16xx.h
|
|
F: drivers/auxdisplay/tm16xx_core.c
|
|
+F: drivers/auxdisplay/tm16xx_i2c.c
|
|
F: drivers/auxdisplay/tm16xx_keypad.c
|
|
|
|
TMIO/SDHI MMC DRIVER
|
|
diff --git a/drivers/auxdisplay/Kconfig b/drivers/auxdisplay/Kconfig
|
|
index f9a2c0641c3c..d48c2f18950e 100644
|
|
--- a/drivers/auxdisplay/Kconfig
|
|
+++ b/drivers/auxdisplay/Kconfig
|
|
@@ -544,6 +544,22 @@ config TM16XX_KEYPAD
|
|
help
|
|
Enable keyscan support for TM16XX driver.
|
|
|
|
+config TM16XX_I2C
|
|
+ tristate "TM16XX-compatible I2C 7-segment LED controllers with keyscan"
|
|
+ depends on I2C
|
|
+ select TM16XX
|
|
+ help
|
|
+ This driver supports the following TM16XX compatible
|
|
+ I2C (2-wire) 7-segment led display chips:
|
|
+ - Titanmec: TM1650
|
|
+ - Fuda Hisi: FD650, FD655, FD6551
|
|
+ - i-Core: AiP650
|
|
+ - Winrise: HBS658
|
|
+
|
|
+ To compile this driver as a module, choose M here: the module
|
|
+ will be called tm16xx_i2c and you will also get tm16xx for the
|
|
+ core module.
|
|
+
|
|
#
|
|
# Character LCD with non-conforming interface section
|
|
#
|
|
diff --git a/drivers/auxdisplay/Makefile b/drivers/auxdisplay/Makefile
|
|
index a9b9c8ff05e8..ba7b310f5667 100644
|
|
--- a/drivers/auxdisplay/Makefile
|
|
+++ b/drivers/auxdisplay/Makefile
|
|
@@ -19,3 +19,4 @@ obj-$(CONFIG_SEG_LED_GPIO) += seg-led-gpio.o
|
|
obj-$(CONFIG_TM16XX) += tm16xx.o
|
|
tm16xx-y += tm16xx_core.o
|
|
tm16xx-$(CONFIG_TM16XX_KEYPAD) += tm16xx_keypad.o
|
|
+obj-$(CONFIG_TM16XX_I2C) += tm16xx_i2c.o
|
|
diff --git a/drivers/auxdisplay/tm16xx_i2c.c b/drivers/auxdisplay/tm16xx_i2c.c
|
|
new file mode 100644
|
|
index 000000000000..013becedac11
|
|
--- /dev/null
|
|
+++ b/drivers/auxdisplay/tm16xx_i2c.c
|
|
@@ -0,0 +1,332 @@
|
|
+// SPDX-License-Identifier: GPL-2.0
|
|
+/*
|
|
+ * TM16xx and compatible LED display/keypad controller driver
|
|
+ * Supports TM16xx, FD6xx, PT6964, HBS658, AIP16xx and related chips.
|
|
+ *
|
|
+ * Copyright (C) 2025 Jean-François Lessard
|
|
+ */
|
|
+
|
|
+#include <linux/bitfield.h>
|
|
+#include <linux/device.h>
|
|
+#include <linux/i2c.h>
|
|
+#include <linux/mod_devicetable.h>
|
|
+#include <linux/module.h>
|
|
+
|
|
+#include "tm16xx.h"
|
|
+
|
|
+static int tm16xx_i2c_probe(struct i2c_client *client)
|
|
+{
|
|
+ const struct tm16xx_controller *controller;
|
|
+ struct tm16xx_display *display;
|
|
+ int ret;
|
|
+
|
|
+ controller = i2c_get_match_data(client);
|
|
+ if (!controller)
|
|
+ return -EINVAL;
|
|
+
|
|
+ display = devm_kzalloc(&client->dev, sizeof(*display), GFP_KERNEL);
|
|
+ if (!display)
|
|
+ return -ENOMEM;
|
|
+
|
|
+ display->dev = &client->dev;
|
|
+ display->controller = controller;
|
|
+
|
|
+ i2c_set_clientdata(client, display);
|
|
+
|
|
+ ret = tm16xx_probe(display);
|
|
+ if (ret)
|
|
+ return ret;
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static void tm16xx_i2c_remove(struct i2c_client *client)
|
|
+{
|
|
+ struct tm16xx_display *display = i2c_get_clientdata(client);
|
|
+
|
|
+ tm16xx_remove(display);
|
|
+}
|
|
+
|
|
+/**
|
|
+ * tm16xx_i2c_write() - I2C write helper for controller
|
|
+ * @display: pointer to tm16xx_display structure
|
|
+ * @data: command and data bytes to send
|
|
+ * @len: number of bytes in @data
|
|
+ *
|
|
+ * Return: 0 on success, negative error code on failure
|
|
+ */
|
|
+static int tm16xx_i2c_write(struct tm16xx_display *display, u8 *data, size_t len)
|
|
+{
|
|
+ struct i2c_client *i2c = to_i2c_client(display->dev);
|
|
+
|
|
+ /* expected sequence: S Command [A] Data [A] P */
|
|
+ struct i2c_msg msg = {
|
|
+ .addr = data[0] >> 1,
|
|
+ .flags = 0,
|
|
+ .len = len - 1,
|
|
+ .buf = &data[1],
|
|
+ };
|
|
+ int ret;
|
|
+
|
|
+ ret = i2c_transfer(i2c->adapter, &msg, 1);
|
|
+ if (ret < 0)
|
|
+ return ret;
|
|
+
|
|
+ return (ret == 1) ? 0 : -EIO;
|
|
+}
|
|
+
|
|
+/**
|
|
+ * tm16xx_i2c_read() - I2C read helper for controller
|
|
+ * @display: pointer to tm16xx_display structure
|
|
+ * @cmd: command/address byte to send before reading
|
|
+ * @data: buffer to receive data
|
|
+ * @len: number of bytes to read into @data
|
|
+ *
|
|
+ * Return: 0 on success, negative error code on failure
|
|
+ */
|
|
+static int tm16xx_i2c_read(struct tm16xx_display *display, u8 cmd, u8 *data, size_t len)
|
|
+{
|
|
+ struct i2c_client *i2c = to_i2c_client(display->dev);
|
|
+
|
|
+ /* expected sequence: S Command [A] [Data] [A] P */
|
|
+ struct i2c_msg msgs[1] = {{
|
|
+ .addr = cmd >> 1,
|
|
+ .flags = I2C_M_RD | I2C_M_NO_RD_ACK,
|
|
+ .len = len,
|
|
+ .buf = data,
|
|
+ }};
|
|
+ int ret;
|
|
+
|
|
+ ret = i2c_transfer(i2c->adapter, msgs, ARRAY_SIZE(msgs));
|
|
+ if (ret < 0)
|
|
+ return ret;
|
|
+
|
|
+ return (ret == ARRAY_SIZE(msgs)) ? 0 : -EIO;
|
|
+}
|
|
+
|
|
+/* I2C controller-specific functions */
|
|
+static int tm1650_init(struct tm16xx_display *display)
|
|
+{
|
|
+ const enum led_brightness brightness = display->main_led.brightness;
|
|
+ u8 cmds[2];
|
|
+
|
|
+ cmds[0] = TM1650_CMD_CTRL;
|
|
+ cmds[1] = TM16XX_CTRL_BRIGHTNESS(brightness, brightness, TM1650) |
|
|
+ TM1650_CTRL_SEG8_MODE;
|
|
+
|
|
+ return tm16xx_i2c_write(display, cmds, ARRAY_SIZE(cmds));
|
|
+}
|
|
+
|
|
+static int tm1650_data(struct tm16xx_display *display, u8 index,
|
|
+ unsigned int grid)
|
|
+{
|
|
+ u8 cmds[2];
|
|
+
|
|
+ cmds[0] = TM1650_CMD_ADDR + index * 2;
|
|
+ cmds[1] = grid; /* SEG 1 to 8 */
|
|
+
|
|
+ return tm16xx_i2c_write(display, cmds, ARRAY_SIZE(cmds));
|
|
+}
|
|
+
|
|
+static int tm1650_keys(struct tm16xx_display *display)
|
|
+{
|
|
+ int row, col;
|
|
+ bool pressed;
|
|
+ u8 keycode;
|
|
+ int ret;
|
|
+
|
|
+ ret = tm16xx_i2c_read(display, TM1650_CMD_READ, &keycode, 1);
|
|
+ if (ret)
|
|
+ return ret;
|
|
+
|
|
+ if (keycode == 0x00 || keycode == 0xFF)
|
|
+ return -EINVAL;
|
|
+
|
|
+ row = FIELD_GET(TM1650_KEY_ROW_MASK, keycode);
|
|
+ pressed = FIELD_GET(TM1650_KEY_DOWN_MASK, keycode) != 0;
|
|
+ if ((keycode & TM1650_KEY_COMBINED) == TM1650_KEY_COMBINED) {
|
|
+ tm16xx_set_key(display, row, 0, pressed);
|
|
+ tm16xx_set_key(display, row, 1, pressed);
|
|
+ } else {
|
|
+ col = FIELD_GET(TM1650_KEY_COL_MASK, keycode);
|
|
+ tm16xx_set_key(display, row, col, pressed);
|
|
+ }
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int fd655_init(struct tm16xx_display *display)
|
|
+{
|
|
+ const enum led_brightness brightness = display->main_led.brightness;
|
|
+ u8 cmds[2];
|
|
+
|
|
+ cmds[0] = FD655_CMD_CTRL;
|
|
+ cmds[1] = TM16XX_CTRL_BRIGHTNESS(brightness, brightness % 3, FD655);
|
|
+
|
|
+ return tm16xx_i2c_write(display, cmds, ARRAY_SIZE(cmds));
|
|
+}
|
|
+
|
|
+static int fd655_data(struct tm16xx_display *display, u8 index,
|
|
+ unsigned int grid)
|
|
+{
|
|
+ u8 cmds[2];
|
|
+
|
|
+ cmds[0] = FD655_CMD_ADDR + index * 2;
|
|
+ cmds[1] = grid; /* SEG 1 to 8 */
|
|
+
|
|
+ return tm16xx_i2c_write(display, cmds, ARRAY_SIZE(cmds));
|
|
+}
|
|
+
|
|
+static int fd6551_init(struct tm16xx_display *display)
|
|
+{
|
|
+ const enum led_brightness brightness = display->main_led.brightness;
|
|
+ u8 cmds[2];
|
|
+
|
|
+ cmds[0] = FD6551_CMD_CTRL;
|
|
+ cmds[1] = TM16XX_CTRL_BRIGHTNESS(brightness, ~(brightness - 1), FD6551);
|
|
+
|
|
+ return tm16xx_i2c_write(display, cmds, ARRAY_SIZE(cmds));
|
|
+}
|
|
+
|
|
+static void hbs658_swap_nibbles(u8 *data, size_t len)
|
|
+{
|
|
+ for (size_t i = 0; i < len; i++)
|
|
+ data[i] = (data[i] << 4) | (data[i] >> 4);
|
|
+}
|
|
+
|
|
+static int hbs658_init(struct tm16xx_display *display)
|
|
+{
|
|
+ const enum led_brightness brightness = display->main_led.brightness;
|
|
+ u8 cmd;
|
|
+ int ret;
|
|
+
|
|
+ /* Set data command */
|
|
+ cmd = TM16XX_CMD_WRITE | TM16XX_DATA_ADDR_AUTO;
|
|
+ hbs658_swap_nibbles(&cmd, 1);
|
|
+ ret = tm16xx_i2c_write(display, &cmd, 1);
|
|
+ if (ret)
|
|
+ return ret;
|
|
+
|
|
+ /* Set control command with brightness */
|
|
+ cmd = TM16XX_CMD_CTRL |
|
|
+ TM16XX_CTRL_BRIGHTNESS(brightness, brightness - 1, TM16XX);
|
|
+ hbs658_swap_nibbles(&cmd, 1);
|
|
+ ret = tm16xx_i2c_write(display, &cmd, 1);
|
|
+ if (ret)
|
|
+ return ret;
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static int hbs658_data(struct tm16xx_display *display, u8 index,
|
|
+ unsigned int grid)
|
|
+{
|
|
+ u8 cmds[2];
|
|
+
|
|
+ cmds[0] = TM16XX_CMD_ADDR + index * 2;
|
|
+ cmds[1] = grid;
|
|
+
|
|
+ hbs658_swap_nibbles(cmds, ARRAY_SIZE(cmds));
|
|
+ return tm16xx_i2c_write(display, cmds, ARRAY_SIZE(cmds));
|
|
+}
|
|
+
|
|
+static int hbs658_keys(struct tm16xx_display *display)
|
|
+{
|
|
+ u8 cmd, keycode;
|
|
+ int col;
|
|
+ int ret;
|
|
+
|
|
+ cmd = TM16XX_CMD_READ;
|
|
+ hbs658_swap_nibbles(&cmd, 1);
|
|
+ ret = tm16xx_i2c_read(display, cmd, &keycode, 1);
|
|
+ if (ret)
|
|
+ return ret;
|
|
+
|
|
+ hbs658_swap_nibbles(&keycode, 1);
|
|
+
|
|
+ if (keycode != 0xFF) {
|
|
+ col = FIELD_GET(HBS658_KEY_COL_MASK, keycode);
|
|
+ tm16xx_set_key(display, 0, col, true);
|
|
+ }
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+/* I2C controller definitions */
|
|
+static const struct tm16xx_controller tm1650_controller = {
|
|
+ .max_grids = 4,
|
|
+ .max_segments = 8,
|
|
+ .max_brightness = 8,
|
|
+ .max_key_rows = 4,
|
|
+ .max_key_cols = 7,
|
|
+ .init = tm1650_init,
|
|
+ .data = tm1650_data,
|
|
+ .keys = tm1650_keys,
|
|
+};
|
|
+
|
|
+static const struct tm16xx_controller fd655_controller = {
|
|
+ .max_grids = 5,
|
|
+ .max_segments = 7,
|
|
+ .max_brightness = 3,
|
|
+ .max_key_rows = 5,
|
|
+ .max_key_cols = 7,
|
|
+ .init = fd655_init,
|
|
+ .data = fd655_data,
|
|
+ .keys = tm1650_keys,
|
|
+};
|
|
+
|
|
+static const struct tm16xx_controller fd6551_controller = {
|
|
+ .max_grids = 5,
|
|
+ .max_segments = 7,
|
|
+ .max_brightness = 8,
|
|
+ .max_key_rows = 0,
|
|
+ .max_key_cols = 0,
|
|
+ .init = fd6551_init,
|
|
+ .data = fd655_data,
|
|
+};
|
|
+
|
|
+static const struct tm16xx_controller hbs658_controller = {
|
|
+ .max_grids = 5,
|
|
+ .max_segments = 8,
|
|
+ .max_brightness = 8,
|
|
+ .max_key_rows = 1,
|
|
+ .max_key_cols = 8,
|
|
+ .init = hbs658_init,
|
|
+ .data = hbs658_data,
|
|
+ .keys = hbs658_keys,
|
|
+};
|
|
+
|
|
+static const struct of_device_id tm16xx_i2c_of_match[] = {
|
|
+ { .compatible = "titanmec,tm1650", .data = &tm1650_controller },
|
|
+ { .compatible = "fdhisi,fd6551", .data = &fd6551_controller },
|
|
+ { .compatible = "fdhisi,fd655", .data = &fd655_controller },
|
|
+ { .compatible = "winrise,hbs658", .data = &hbs658_controller },
|
|
+ { /* sentinel */ }
|
|
+};
|
|
+MODULE_DEVICE_TABLE(of, tm16xx_i2c_of_match);
|
|
+
|
|
+static const struct i2c_device_id tm16xx_i2c_id[] = {
|
|
+ { "tm1650", (kernel_ulong_t)&tm1650_controller },
|
|
+ { "fd6551", (kernel_ulong_t)&fd6551_controller },
|
|
+ { "fd655", (kernel_ulong_t)&fd655_controller },
|
|
+ { "hbs658", (kernel_ulong_t)&hbs658_controller },
|
|
+ { /* sentinel */ }
|
|
+};
|
|
+MODULE_DEVICE_TABLE(i2c, tm16xx_i2c_id);
|
|
+
|
|
+static struct i2c_driver tm16xx_i2c_driver = {
|
|
+ .driver = {
|
|
+ .name = "tm16xx-i2c",
|
|
+ .of_match_table = tm16xx_i2c_of_match,
|
|
+ },
|
|
+ .probe = tm16xx_i2c_probe,
|
|
+ .remove = tm16xx_i2c_remove,
|
|
+ .shutdown = tm16xx_i2c_remove,
|
|
+ .id_table = tm16xx_i2c_id,
|
|
+};
|
|
+module_i2c_driver(tm16xx_i2c_driver);
|
|
+
|
|
+MODULE_AUTHOR("Jean-François Lessard");
|
|
+MODULE_DESCRIPTION("TM16xx-i2c LED Display Controllers");
|
|
+MODULE_LICENSE("GPL");
|
|
+MODULE_IMPORT_NS("TM16XX");
|
|
--
|
|
2.34.1
|
|
|