[PATCH 7/8] drm/bridge: it66121: Add another implementation for getting match data

Sui Jingfeng
2023-11-14T15:09:57Z

From: Sui Jingfeng <suijingfeng@loongson.cn>

Because if use the i2c_get_match_data() function on our platform, the
following error will emerge.

[ 3.597872] ACPI: bus type drm_connector registered
[ 3.602877] loongson 0000:00:06.1: Found LS7A1000 bridge chipset, revision: 1
[ 3.610013] loongson 0000:00:06.1: [drm] dc: 264MHz, gmc: 529MHz, gpu: 529MHz
[ 3.617111] loongson 0000:00:06.1: [drm] Dedicated vram start: 0xe0030000000, size: 64MiB
[ 3.633628] loongson 0000:00:06.1: [drm] Loongson VBIOS version: 0.3
[ 3.639944] loongson 0000:00:06.1: [drm] Loongson VBIOS: has 8 DCBs
[ 3.646271] Console: switching to colour dummy device 80x25
[ 3.651902] loongson 0000:00:06.1: [drm] VRAM: 4096 pages ready
[ 3.657791] loongson 0000:00:06.1: [drm] GTT: 32768 pages ready
[ 3.663731] loongson 0000:00:06.1: [drm] lsdc-i2c0(sda pin mask=1, scl pin mask=2) created
[ 3.671966] loongson 0000:00:06.1: [drm] lsdc-i2c1(sda pin mask=4, scl pin mask=8) created
[ 3.680188] loongson 0000:00:06.1: [drm] DisplayPipe-0 has DVO-0 connector
[ 3.711860] debugfs: Directory '1-004c' with parent 'regmap' already present!
[ 3.720312] CPU 0 Unable to handle kernel paging request at virtual address 0000000000000090, era == 9000000002faffec, ra == 9000000002faffc8
[ 3.732935] Oops[#1]:
[ 3.735187] CPU: 0 PID: 8 Comm: kworker/0:0 Not tainted 6.6.0-rc3+ #941
[ 3.741757] Hardware name: Loongson Loongson-3A5000-7A1000-1w-ML5A/Loongson-LS3A5000-7A1000-1w-ML5A, BIOS vUDK2018-LoongArch-V4.0.05-test-stable202305 06/
[ 3.755500] Workqueue: events work_for_cpu_fn
[ 3.759833] pc 9000000002faffec ra 9000000002faffc8 tp 900000010017c000 sp 900000010017fb80
[ 3.768132] a0 0000000000000000 a1 9000000101c00420 a2 0000000000000001 a3 900000010017fbc0
[ 3.776430] a4 0000000000000004 a5 0000000000000000 a6 0000000000000001 a7 0000000000000001
[ 3.784727] t0 0000000000000000 t1 0000000000000001 t2 0000000006124954 t3 0000000000000012
[ 3.793026] t4 0000000000004954 t5 900000000800b530 t6 0000000000000000 t7 0000000000018500
[ 3.801324] t8 90000001019c90c0 u0 9000000101c00c00 s9 fffffffffffff000 s0 9000000101c00400
[ 3.809621] s1 0000000000000000 s2 0000000000000000 s3 9000000003c42cb0 s4 9000000101c00420
[ 3.817920] s5 900000010017fc48 s6 0000000000000000 s7 0000000000000000 s8 90000000037fa000
[ 3.826219] ra: 9000000002faffc8 i2c_get_match_data+0x24/0xac
[ 3.832189] ERA: 9000000002faffec i2c_get_match_data+0x48/0xac
[ 3.838156] CRMD: 000000b0 (PLV0 -IE -DA +PG DACF=CC DACM=CC -WE)
[ 3.844303] PRMD: 00000004 (PPLV0 +PIE -PWE)
[ 3.848631] EUEN: 00000000 (-FPE -SXE -ASXE -BTE)
[ 3.853391] ECFG: 00071c1d (LIE=0,2-4,10-12 VS=7)
[ 3.858149] ESTAT: 00010000 [PIL] (IS= ECode=1 EsubCode=0)
[ 3.863599] BADV: 0000000000000090
[ 3.867058] PRID: 0014c011 (Loongson-64bit, Loongson-3A5000)
[ 3.872764] Modules linked in:
[ 3.875793] Process kworker/0:0 (pid: 8, threadinfo=(____ptrval____), task=(____ptrval____))
[ 3.884180] Stack : 9000000101c00400 0000000000000000 900000010177f428 9000000002ceb734
[ 3.892137] 9000000101c00404 90000000037fa000 900000010017fc60 9000000101c00400
[ 3.900093] 9000000016124954 8c326e68047d36df 0000004c037fa000 900000010017fc50
[ 3.908050] 0000000000000080 9000000003c44490 900000010017fcb0 90000001003e9ec0
[ 3.916007] 0000000000000001 900000010044f000 900000010017fc60 9000000101c00400
[ 3.923964] 90000000037fa000 9000000002cf05a8 90000001003e8000 900000010017fcb2
[ 3.931920] 000000304c17fc68 0000000000000000 000000000000004c 0000000000000000
[ 3.939877] 4031323136365449 0000000000006334 004c000000000000 0000000000000000
[ 3.947833] 0000000000000000 0000000000000000 0000000000000000 0000000000000000
[ 3.955790] 0000000000000000 0000000000000000 9000000100449a98 8c326e68047d36df
[ 3.963746] ...
[ 3.966170] Call Trace:
[ 3.966172] [<9000000002faffec>] i2c_get_match_data+0x48/0xac
[ 3.974304] [<9000000002ceb734>] it66121_create_bridge+0x15c/0x404
[ 3.980446] [<9000000002cf05a8>] ls7a1000_output_init+0x228/0x248
[ 3.986503] [<9000000002cee494>] lsdc_pci_probe+0x4dc/0x5b0
[ 3.992038] [<9000000002b86b50>] local_pci_probe+0x48/0xa0
[ 3.997487] [<90000000023b5d04>] work_for_cpu_fn+0x1c/0x30
[ 4.002936] [<90000000023b7c0c>] process_one_work+0x14c/0x288
[ 4.008644] [<90000000023b8084>] worker_thread+0x33c/0x438
[ 4.014092] [<90000000023c1ccc>] kthread+0x124/0x130
[ 4.019023] [<9000000002381188>] ret_from_kernel_thread+0xc/0xa4
[ 4.024991]
[ 4.026463] Code: 26000079 02c08063 4c000020 <28c24318> 43ffe31f 43ffdeff 2a00030c 43ffd59f 02c012f7
[ 4.036154]
[ 4.037630] ---[ end trace 0000000000000000 ]---

Signed-off-by: Sui Jingfeng <suijingfeng@loongson.cn>
---
drivers/gpu/drm/bridge/ite-it66121.c | 51 +++++++++++++++++++---------
1 file changed, 35 insertions(+), 16 deletions(-)

diff --git a/drivers/gpu/drm/bridge/ite-it66121.c b/drivers/gpu/drm/bridge/ite-it66121.c
index 2f7f00f1bedb..8971414a2a60 100644
--- a/drivers/gpu/drm/bridge/ite-it66121.c
+++ b/drivers/gpu/drm/bridge/ite-it66121.c
@@ -292,8 +292,39 @@ enum chip_id {
struct it66121_chip_info {
enum chip_id id;
u16 vid, pid;
+ char name[24];
};

+static const struct it66121_chip_info it66121_chip_info[] = {
+ {
+ .id = ID_IT66121,
+ .vid = 0x4954,
+ .pid = 0x0612,
+ .name = "IT66121",
+ },
+ {
+ .id = ID_IT6610,
+ .vid = 0xca00,
+ .pid = 0x0611,
+ .name = "IT6610",
+ },
+};
+
+static const struct it66121_chip_info *
+it66121_get_match_data(u16 vender_id, u16 device_id)
+{
+ const struct it66121_chip_info *info;
+ unsigned int i;
+
+ for (i = 0; i < ARRAY_SIZE(it66121_chip_info); i++) {
+ info = &it66121_chip_info[i];
+ if (info->vid == vender_id && info->pid == device_id)
+ return info;
+ }
+
+ return NULL;
+}
+
struct it66121_ctx {
struct regmap *regmap;
struct drm_bridge bridge;
@@ -1677,28 +1708,16 @@ static void it66121_remove(struct i2c_client *client)
mutex_destroy(&ctx->lock);
}

-static const struct it66121_chip_info it66121_chip_info = {
- .id = ID_IT66121,
- .vid = 0x4954,
- .pid = 0x0612,
-};
-
-static const struct it66121_chip_info it6610_chip_info = {
- .id = ID_IT6610,
- .vid = 0xca00,
- .pid = 0x0611,
-};
-
static const struct of_device_id it66121_dt_match[] = {
- { .compatible = "ite,it66121", &it66121_chip_info },
- { .compatible = "ite,it6610", &it6610_chip_info },
+ { .compatible = "ite,it66121", &it66121_chip_info[0] },
+ { .compatible = "ite,it6610", &it66121_chip_info[1] },
{ }
};
MODULE_DEVICE_TABLE(of, it66121_dt_match);

static const struct i2c_device_id it66121_id[] = {
- { "it66121", (kernel_ulong_t) &it66121_chip_info },
- { "it6610", (kernel_ulong_t) &it6610_chip_info },
+ { "it66121", (kernel_ulong_t) &it66121_chip_info[0] },
+ { "it6610", (kernel_ulong_t) &it66121_chip_info[1] },
{ }
};
MODULE_DEVICE_TABLE(i2c, it66121_id);
--
2.34.1