Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * Digital I/O driver for Technologic Systems TS-5500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  * Copyright (c) 2012 Savoir-faire Linux Inc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  *	Vivien Didelot <vivien.didelot@savoirfairelinux.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8)  * Technologic Systems platforms have pin blocks, exposing several Digital
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9)  * Input/Output lines (DIO). This driver aims to support single pin blocks.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10)  * In that sense, the support is not limited to the TS-5500 blocks.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11)  * Actually, the following platforms have DIO support:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13)  * TS-5500:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14)  *   Documentation: http://wiki.embeddedarm.com/wiki/TS-5500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15)  *   Blocks: DIO1, DIO2 and LCD port.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17)  * TS-5600:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18)  *   Documentation: http://wiki.embeddedarm.com/wiki/TS-5600
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19)  *   Blocks: LCD port (identical to TS-5500 LCD).
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #include <linux/bitops.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #include <linux/gpio/driver.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) #include <linux/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) /* List of supported Technologic Systems platforms DIO blocks */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) enum ts5500_blocks { TS5500_DIO1, TS5500_DIO2, TS5500_LCD, TS5600_LCD };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) struct ts5500_priv {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 	const struct ts5500_dio *pinout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 	struct gpio_chip gpio_chip;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 	spinlock_t lock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 	bool strap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 	u8 hwirq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41)  * Hex 7D is used to control several blocks (e.g. DIO2 and LCD port).
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42)  * This flag ensures that the region has been requested by this driver.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) static bool hex7d_reserved;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47)  * This structure is used to describe capabilities of DIO lines,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48)  * such as available directions and connected interrupt (if any).
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) struct ts5500_dio {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 	const u8 value_addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 	const u8 value_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 	const u8 control_addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 	const u8 control_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 	const bool no_input;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 	const bool no_output;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 	const u8 irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) #define TS5500_DIO_IN_OUT(vaddr, vbit, caddr, cbit)	\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 	{						\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 		.value_addr = vaddr,			\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 		.value_mask = BIT(vbit),		\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 		.control_addr = caddr,			\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 		.control_mask = BIT(cbit),		\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) #define TS5500_DIO_IN(addr, bit)		\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 	{					\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 		.value_addr = addr,		\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 		.value_mask = BIT(bit),		\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 		.no_output = true,		\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) #define TS5500_DIO_IN_IRQ(addr, bit, _irq)	\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 	{					\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 		.value_addr = addr,		\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 		.value_mask = BIT(bit),		\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 		.no_output = true,		\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 		.irq = _irq,			\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) #define TS5500_DIO_OUT(addr, bit)		\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	{					\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 		.value_addr = addr,		\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 		.value_mask = BIT(bit),		\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 		.no_input = true,		\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91)  * Input/Output DIO lines are programmed in groups of 4. Their values are
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92)  * available through 4 consecutive bits in a value port, whereas the direction
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93)  * of these 4 lines is driven by only 1 bit in a control port.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) #define TS5500_DIO_GROUP(vaddr, vbitfrom, caddr, cbit)		\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 	TS5500_DIO_IN_OUT(vaddr, vbitfrom + 0, caddr, cbit),	\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 	TS5500_DIO_IN_OUT(vaddr, vbitfrom + 1, caddr, cbit),	\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	TS5500_DIO_IN_OUT(vaddr, vbitfrom + 2, caddr, cbit),	\
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 	TS5500_DIO_IN_OUT(vaddr, vbitfrom + 3, caddr, cbit)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102)  * TS-5500 DIO1 block
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)  *  value    control  dir    hw
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105)  *  addr bit addr bit in out irq name     pin offset
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107)  *  0x7b  0  0x7a  0  x   x      DIO1_0   1   0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108)  *  0x7b  1  0x7a  0  x   x      DIO1_1   3   1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109)  *  0x7b  2  0x7a  0  x   x      DIO1_2   5   2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110)  *  0x7b  3  0x7a  0  x   x      DIO1_3   7   3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111)  *  0x7b  4  0x7a  1  x   x      DIO1_4   9   4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112)  *  0x7b  5  0x7a  1  x   x      DIO1_5   11  5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)  *  0x7b  6  0x7a  1  x   x      DIO1_6   13  6
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114)  *  0x7b  7  0x7a  1  x   x      DIO1_7   15  7
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115)  *  0x7c  0  0x7a  5  x   x      DIO1_8   4   8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116)  *  0x7c  1  0x7a  5  x   x      DIO1_9   6   9
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117)  *  0x7c  2  0x7a  5  x   x      DIO1_10  8   10
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118)  *  0x7c  3  0x7a  5  x   x      DIO1_11  10  11
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119)  *  0x7c  4           x          DIO1_12  12  12
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120)  *  0x7c  5           x      7   DIO1_13  14  13
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) static const struct ts5500_dio ts5500_dio1[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 	TS5500_DIO_GROUP(0x7b, 0, 0x7a, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 	TS5500_DIO_GROUP(0x7b, 4, 0x7a, 1),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 	TS5500_DIO_GROUP(0x7c, 0, 0x7a, 5),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 	TS5500_DIO_IN(0x7c, 4),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 	TS5500_DIO_IN_IRQ(0x7c, 5, 7),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131)  * TS-5500 DIO2 block
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133)  *  value    control  dir    hw
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134)  *  addr bit addr bit in out irq name     pin offset
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136)  *  0x7e  0  0x7d  0  x   x      DIO2_0   1   0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137)  *  0x7e  1  0x7d  0  x   x      DIO2_1   3   1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)  *  0x7e  2  0x7d  0  x   x      DIO2_2   5   2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139)  *  0x7e  3  0x7d  0  x   x      DIO2_3   7   3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140)  *  0x7e  4  0x7d  1  x   x      DIO2_4   9   4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141)  *  0x7e  5  0x7d  1  x   x      DIO2_5   11  5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142)  *  0x7e  6  0x7d  1  x   x      DIO2_6   13  6
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143)  *  0x7e  7  0x7d  1  x   x      DIO2_7   15  7
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144)  *  0x7f  0  0x7d  5  x   x      DIO2_8   4   8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145)  *  0x7f  1  0x7d  5  x   x      DIO2_9   6   9
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146)  *  0x7f  2  0x7d  5  x   x      DIO2_10  8   10
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147)  *  0x7f  3  0x7d  5  x   x      DIO2_11  10  11
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148)  *  0x7f  4           x      6   DIO2_13  14  12
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) static const struct ts5500_dio ts5500_dio2[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 	TS5500_DIO_GROUP(0x7e, 0, 0x7d, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 	TS5500_DIO_GROUP(0x7e, 4, 0x7d, 1),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 	TS5500_DIO_GROUP(0x7f, 0, 0x7d, 5),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 	TS5500_DIO_IN_IRQ(0x7f, 4, 6),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158)  * TS-5500 LCD port used as DIO block
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159)  * TS-5600 LCD port is identical
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161)  *  value    control  dir    hw
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162)  *  addr bit addr bit in out irq name    pin offset
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164)  *  0x72  0  0x7d  2  x   x      LCD_0   8   0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165)  *  0x72  1  0x7d  2  x   x      LCD_1   7   1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166)  *  0x72  2  0x7d  2  x   x      LCD_2   10  2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167)  *  0x72  3  0x7d  2  x   x      LCD_3   9   3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168)  *  0x72  4  0x7d  3  x   x      LCD_4   12  4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169)  *  0x72  5  0x7d  3  x   x      LCD_5   11  5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170)  *  0x72  6  0x7d  3  x   x      LCD_6   14  6
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171)  *  0x72  7  0x7d  3  x   x      LCD_7   13  7
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172)  *  0x73  0               x      LCD_EN  5   8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173)  *  0x73  6           x          LCD_WR  6   9
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174)  *  0x73  7           x      1   LCD_RS  3   10
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) static const struct ts5500_dio ts5500_lcd[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 	TS5500_DIO_GROUP(0x72, 0, 0x7d, 2),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 	TS5500_DIO_GROUP(0x72, 4, 0x7d, 3),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 	TS5500_DIO_OUT(0x73, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 	TS5500_DIO_IN(0x73, 6),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 	TS5500_DIO_IN_IRQ(0x73, 7, 1),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) static inline void ts5500_set_mask(u8 mask, u8 addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 	u8 val = inb(addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 	val |= mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 	outb(val, addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) static inline void ts5500_clear_mask(u8 mask, u8 addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 	u8 val = inb(addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 	val &= ~mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 	outb(val, addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) static int ts5500_gpio_input(struct gpio_chip *chip, unsigned offset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 	struct ts5500_priv *priv = gpiochip_get_data(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 	const struct ts5500_dio line = priv->pinout[offset];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 	unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 	if (line.no_input)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 		return -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 	if (line.no_output)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 	spin_lock_irqsave(&priv->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 	ts5500_clear_mask(line.control_mask, line.control_addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 	spin_unlock_irqrestore(&priv->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) static int ts5500_gpio_get(struct gpio_chip *chip, unsigned offset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 	struct ts5500_priv *priv = gpiochip_get_data(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 	const struct ts5500_dio line = priv->pinout[offset];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 	return !!(inb(line.value_addr) & line.value_mask);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) static int ts5500_gpio_output(struct gpio_chip *chip, unsigned offset, int val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 	struct ts5500_priv *priv = gpiochip_get_data(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 	const struct ts5500_dio line = priv->pinout[offset];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 	unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 	if (line.no_output)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 		return -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 	spin_lock_irqsave(&priv->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 	if (!line.no_input)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 		ts5500_set_mask(line.control_mask, line.control_addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 	if (val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 		ts5500_set_mask(line.value_mask, line.value_addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 		ts5500_clear_mask(line.value_mask, line.value_addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 	spin_unlock_irqrestore(&priv->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) static void ts5500_gpio_set(struct gpio_chip *chip, unsigned offset, int val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 	struct ts5500_priv *priv = gpiochip_get_data(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 	const struct ts5500_dio line = priv->pinout[offset];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 	unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 	spin_lock_irqsave(&priv->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 	if (val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 		ts5500_set_mask(line.value_mask, line.value_addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 		ts5500_clear_mask(line.value_mask, line.value_addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 	spin_unlock_irqrestore(&priv->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) static int ts5500_gpio_to_irq(struct gpio_chip *chip, unsigned offset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 	struct ts5500_priv *priv = gpiochip_get_data(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 	const struct ts5500_dio *block = priv->pinout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 	const struct ts5500_dio line = block[offset];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 	/* Only one pin is connected to an interrupt */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 	if (line.irq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 		return line.irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 	/* As this pin is input-only, we may strap it to another in/out pin */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 	if (priv->strap)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 		return priv->hwirq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 	return -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) static int ts5500_enable_irq(struct ts5500_priv *priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 	int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 	unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 	spin_lock_irqsave(&priv->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 	if (priv->hwirq == 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 		ts5500_set_mask(BIT(7), 0x7a); /* DIO1_13 on IRQ7 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 	else if (priv->hwirq == 6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 		ts5500_set_mask(BIT(7), 0x7d); /* DIO2_13 on IRQ6 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 	else if (priv->hwirq == 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 		ts5500_set_mask(BIT(6), 0x7d); /* LCD_RS on IRQ1 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 		ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) 	spin_unlock_irqrestore(&priv->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) static void ts5500_disable_irq(struct ts5500_priv *priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 	unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 	spin_lock_irqsave(&priv->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 	if (priv->hwirq == 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 		ts5500_clear_mask(BIT(7), 0x7a); /* DIO1_13 on IRQ7 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 	else if (priv->hwirq == 6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) 		ts5500_clear_mask(BIT(7), 0x7d); /* DIO2_13 on IRQ6 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 	else if (priv->hwirq == 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 		ts5500_clear_mask(BIT(6), 0x7d); /* LCD_RS on IRQ1 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 		dev_err(priv->gpio_chip.parent, "invalid hwirq %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 			priv->hwirq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 	spin_unlock_irqrestore(&priv->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) static int ts5500_dio_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 	enum ts5500_blocks block = platform_get_device_id(pdev)->driver_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 	struct device *dev = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 	const char *name = dev_name(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 	struct ts5500_priv *priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) 	struct resource *res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) 	unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) 	res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) 	if (!res) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) 		dev_err(dev, "missing IRQ resource\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) 	priv = devm_kzalloc(dev, sizeof(struct ts5500_priv), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) 	if (!priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) 	platform_set_drvdata(pdev, priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) 	priv->hwirq = res->start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) 	spin_lock_init(&priv->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) 	priv->gpio_chip.owner = THIS_MODULE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) 	priv->gpio_chip.label = name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) 	priv->gpio_chip.parent = dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) 	priv->gpio_chip.direction_input = ts5500_gpio_input;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) 	priv->gpio_chip.direction_output = ts5500_gpio_output;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) 	priv->gpio_chip.get = ts5500_gpio_get;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) 	priv->gpio_chip.set = ts5500_gpio_set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) 	priv->gpio_chip.to_irq = ts5500_gpio_to_irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) 	priv->gpio_chip.base = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) 	switch (block) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) 	case TS5500_DIO1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) 		priv->pinout = ts5500_dio1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) 		priv->gpio_chip.ngpio = ARRAY_SIZE(ts5500_dio1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) 		if (!devm_request_region(dev, 0x7a, 3, name)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) 			dev_err(dev, "failed to request %s ports\n", name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) 			return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) 	case TS5500_DIO2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) 		priv->pinout = ts5500_dio2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) 		priv->gpio_chip.ngpio = ARRAY_SIZE(ts5500_dio2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) 		if (!devm_request_region(dev, 0x7e, 2, name)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) 			dev_err(dev, "failed to request %s ports\n", name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) 			return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) 		if (hex7d_reserved)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) 		if (!devm_request_region(dev, 0x7d, 1, name)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) 			dev_err(dev, "failed to request %s 7D\n", name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) 			return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) 		hex7d_reserved = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) 	case TS5500_LCD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) 	case TS5600_LCD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) 		priv->pinout = ts5500_lcd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) 		priv->gpio_chip.ngpio = ARRAY_SIZE(ts5500_lcd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) 		if (!devm_request_region(dev, 0x72, 2, name)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) 			dev_err(dev, "failed to request %s ports\n", name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) 			return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) 		if (!hex7d_reserved) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) 			if (!devm_request_region(dev, 0x7d, 1, name)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) 				dev_err(dev, "failed to request %s 7D\n", name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) 				return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) 			hex7d_reserved = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) 		/* Ensure usage of LCD port as DIO */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) 		spin_lock_irqsave(&priv->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) 		ts5500_clear_mask(BIT(4), 0x7d);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) 		spin_unlock_irqrestore(&priv->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) 	ret = devm_gpiochip_add_data(dev, &priv->gpio_chip, priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) 		dev_err(dev, "failed to register the gpio chip\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) 	ret = ts5500_enable_irq(priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) 		dev_err(dev, "invalid interrupt %d\n", priv->hwirq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) static int ts5500_dio_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) 	struct ts5500_priv *priv = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) 	ts5500_disable_irq(priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) static const struct platform_device_id ts5500_dio_ids[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) 	{ "ts5500-dio1", TS5500_DIO1 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) 	{ "ts5500-dio2", TS5500_DIO2 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) 	{ "ts5500-dio-lcd", TS5500_LCD },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) 	{ "ts5600-dio-lcd", TS5600_LCD },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) 	{ }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) MODULE_DEVICE_TABLE(platform, ts5500_dio_ids);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) static struct platform_driver ts5500_dio_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) 	.driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) 		.name = "ts5500-dio",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) 	.probe = ts5500_dio_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) 	.remove = ts5500_dio_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) 	.id_table = ts5500_dio_ids,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) module_platform_driver(ts5500_dio_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) MODULE_AUTHOR("Savoir-faire Linux Inc. <kernel@savoirfairelinux.com>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) MODULE_DESCRIPTION("Technologic Systems TS-5500 Digital I/O driver");