Pull i2c updates from Wolfram Sang: - mostly driver updates. Bigger ones for mlxcpld and iproc. But most of them are all over the place. - removal of the efm32, sirf, u300, and zte zx bus drivers because of platform removal. So, we have a pleasant diffstat this time. - first set of cleanups in the I2C core as preparation to increase maximum length of SMBus transfers to 255 (as specified in the new standard). Better documentation of struct i2c_msg and its flags stand out here. - the testunit can now respond to SMBus block process calls which is the testcase when implementing the above new maximum length. * 'i2c/for-5.12' of git://git.kernel.org/pub/scm/linux/kernel/git/wsa/linux: (62 commits) i2c: remove redundant error print in stm32f7_i2c_probe i2c: testunit: add support for block process calls i2c: busses: Replace spin_lock_irqsave with spin_lock in hard IRQ dt-bindings: eeprom: at24: Document ROHM BR24G01 i2c: i801: Add support for Intel Alder Lake PCH-P i2c: mv64xxx: Fix check for missing clock after adding RPM i2c: mux: mlxcpld: Add callback to notify mux creation completion i2c: mux: mlxcpld: Extend supported mux number i2c: mux: mlxcpld: Extend driver to support word address space devices i2c: mux: mlxcpld: Get rid of adapter numbers enforcement i2c: mux: mlxcpld: Prepare mux selection infrastructure for two-byte support i2c: mux: mlxcpld: Convert driver to platform driver i2c: imx: Synthesize end of transaction events without idle interrupts i2c: i2c-qcom-geni: Add shutdown callback for i2c i2c: mv64xxx: Add runtime PM support i2c: amd-mp2: Remove unused macro i2c: amd-mp2: convert to PCI logging functions i2c: mux: mlxcpld: Move header file out of x86 realm platform/x86: mlxcpld: Update module license i2c: mux: mlxcpld: Update module license ...
Unified · Split
| @@ -95,9 +95,6 @@ properties: · 94 unmodified lines | ||
| 95 | 95 | pattern: spd$ |
| 96 | 96 | # These are special cases that don't conform to the above pattern. |
| 97 | 97 | # Each requires a standard at24 model as fallback. |
| 98 | − - items: | |
| 99 | − - const: rohm,br24t01 | |
| 100 | − - const: atmel,24c01 | |
| 101 | 98 | - items: |
| 102 | 99 | - const: nxp,se97b |
| 103 | 100 | - const: atmel,24c02 |
| @@ -113,6 +110,12 @@ properties: · 9 unmodified lines | ||
| 113 | 110 | - items: |
| 114 | 111 | - const: renesas,r1ex24128 |
| 115 | 112 | - const: atmel,24c128 |
| 113 | + - items: | |
| 114 | + - const: rohm,br24g01 | |
| 115 | + - const: atmel,24c01 | |
| 116 | + - items: | |
| 117 | + - const: rohm,br24t01 | |
| 118 | + - const: atmel,24c01 | |
| 116 | 119 | |
| 117 | 120 | label: |
| 118 | 121 | description: Descriptive name of the EEPROM. |
| @@ -1,19 +0,0 @@ | ||
| 1 | −I2C for SiRFprimaII platforms | |
| 2 | − | |
| 3 | −Required properties : | |
| 4 | −- compatible : Must be "sirf,prima2-i2c" | |
| 5 | −- reg: physical base address of the controller and length of memory mapped | |
| 6 | − region. | |
| 7 | −- interrupts: interrupt number to the cpu. | |
| 8 | − | |
| 9 | −Optional properties: | |
| 10 | −- clock-frequency : Constains desired I2C/HS-I2C bus clock frequency in Hz. | |
| 11 | − The absence of the property indicates the default frequency 100 kHz. | |
| 12 | − | |
| 13 | −Examples : | |
| 14 | − | |
| 15 | −i2c0: i2c@b00e0000 { | |
| 16 | − compatible = "sirf,prima2-i2c"; | |
| 17 | − reg = <0xb00e0000 0x10000>; | |
| 18 | − interrupts = <24>; | |
| 19 | −}; | |
| @@ -1,15 +0,0 @@ | ||
| 1 | −ST Microelectronics DDC I2C | |
| 2 | − | |
| 3 | −Required properties : | |
| 4 | −- compatible : Must be "st,ddci2c" | |
| 5 | −- reg: physical base address of the controller and length of memory mapped | |
| 6 | − region. | |
| 7 | −- interrupts: interrupt number to the cpu. | |
| 8 | −- #address-cells = <1>; | |
| 9 | −- #size-cells = <0>; | |
| 10 | − | |
| 11 | −Optional properties: | |
| 12 | −- Child nodes conforming to i2c bus binding | |
| 13 | − | |
| 14 | −Examples : | |
| 15 | − | |
| @@ -1,22 +0,0 @@ | ||
| 1 | −ZTE zx2967 I2C controller | |
| 2 | − | |
| 3 | −Required properties: | |
| 4 | − - compatible: must be "zte,zx296718-i2c" | |
| 5 | − - reg: physical address and length of the device registers | |
| 6 | − - interrupts: a single interrupt specifier | |
| 7 | − - clocks: clock for the device | |
| 8 | − - #address-cells: should be <1> | |
| 9 | − - #size-cells: should be <0> | |
| 10 | − - clock-frequency: the desired I2C bus clock frequency. | |
| 11 | − | |
| 12 | −Examples: | |
| 13 | − | |
| 14 | − i2c@112000 { | |
| 15 | − compatible = "zte,zx296718-i2c"; | |
| 16 | − reg = <0x00112000 0x1000>; | |
| 17 | − interrupts = <GIC_SPI 112 IRQ_TYPE_LEVEL_HIGH>; | |
| 18 | − clocks = <&osc24m>; | |
| 19 | − #address-cells = <1> | |
| 20 | − #size-cells = <0>; | |
| 21 | − clock-frequency = <1600000>; | |
| 22 | − }; | |
| @@ -18,21 +18,14 @@ properties: · 17 unmodified lines | ||
| 18 | 18 | - const: allwinner,sun4i-a10-i2c |
| 19 | 19 | - const: allwinner,sun6i-a31-i2c |
| 20 | 20 | - items: |
| 21 | − - const: allwinner,sun8i-a23-i2c | |
| 21 | + - enum: | |
| 22 | + - allwinner,sun8i-a23-i2c | |
| 23 | + - allwinner,sun8i-a83t-i2c | |
| 24 | + - allwinner,sun50i-a64-i2c | |
| 25 | + - allwinner,sun50i-a100-i2c | |
| 26 | + - allwinner,sun50i-h6-i2c | |
| 27 | + - allwinner,sun50i-h616-i2c | |
| 22 | 28 | - const: allwinner,sun6i-a31-i2c |
| 23 | − - items: | |
| 24 | − - const: allwinner,sun8i-a83t-i2c | |
| 25 | − - const: allwinner,sun6i-a31-i2c | |
| 26 | − - items: | |
| 27 | − - const: allwinner,sun50i-a64-i2c | |
| 28 | − - const: allwinner,sun6i-a31-i2c | |
| 29 | − - items: | |
| 30 | − - const: allwinner,sun50i-a100-i2c | |
| 31 | − - const: allwinner,sun6i-a31-i2c | |
| 32 | − - items: | |
| 33 | − - const: allwinner,sun50i-h6-i2c | |
| 34 | − - const: allwinner,sun6i-a31-i2c | |
| 35 | − | |
| 36 | 29 | - const: marvell,mv64xxx-i2c |
| 37 | 30 | - const: marvell,mv78230-i2c |
| 38 | 31 | - const: marvell,mv78230-a0-i2c |
| @@ -26,6 +26,7 @@ Required properties: · 25 unmodified lines | ||
| 26 | 26 | "renesas,i2c-r8a77980" if the device is a part of a R8A77980 SoC. |
| 27 | 27 | "renesas,i2c-r8a77990" if the device is a part of a R8A77990 SoC. |
| 28 | 28 | "renesas,i2c-r8a77995" if the device is a part of a R8A77995 SoC. |
| 29 | + "renesas,i2c-r8a779a0" if the device is a part of a R8A779A0 SoC. | |
| 29 | 30 | "renesas,rcar-gen1-i2c" for a generic R-Car Gen1 compatible device. |
| 30 | 31 | "renesas,rcar-gen2-i2c" for a generic R-Car Gen2 or RZ/G1 compatible |
| 31 | 32 | device. |
| @@ -22,8 +22,9 @@ Instantiating the device is regular. Example for bus 0, address 0x30: · 21 unmodified lines | ||
| 22 | 22 | |
| 23 | 23 | After that, you will have a write-only device listening. Reads will just return |
| 24 | 24 | an 8-bit version number of the testunit. When writing, the device consists of 4 |
| 25 | −8-bit registers and all must be written to start a testcase, i.e. you must | |
| 26 | −always write 4 bytes to the device. The registers are: | |
| 25 | +8-bit registers and, except for some "partial" commands, all registers must be | |
| 26 | +written to start a testcase, i.e. you usually write 4 bytes to the device. The | |
| 27 | +registers are: | |
| 27 | 28 | |
| 28 | 29 | 0x00 CMD - which test to trigger |
| 29 | 30 | 0x01 DATAL - configuration byte 1 for the test |
| @@ -67,3 +68,21 @@ status word is currently ignored in the Linux Kernel. Example to send a · 37 unmodified lines | ||
| 67 | 68 | notification after 10ms: |
| 68 | 69 | |
| 69 | 70 | # i2cset -y 0 0x30 0x02 0x42 0x64 0x01 i |
| 71 | + | |
| 72 | +0x03 SMBUS_BLOCK_PROC_CALL (partial command) | |
| 73 | + DATAL - must be '1', i.e. one further byte will be written | |
| 74 | + DATAH - number of bytes to be sent back | |
| 75 | + DELAY - not applicable, partial command! | |
| 76 | + | |
| 77 | +This test will respond to a block process call as defined by the SMBus | |
| 78 | +specification. The one data byte written specifies how many bytes will be sent | |
| 79 | +back in the following read transfer. Note that in this read transfer, the | |
| 80 | +testunit will prefix the length of the bytes to follow. So, if your host bus | |
| 81 | +driver emulates SMBus calls like the majority does, it needs to support the | |
| 82 | +I2C_M_RECV_LEN flag of an i2c_msg. This is a good testcase for it. The returned | |
| 83 | +data consists of the length first, and then of an array of bytes from length-1 | |
| 84 | +to 0. Here is an example which emulates i2c_smbus_block_process_call() using | |
| 85 | +i2ctransfer (you need i2c-tools v4.2 or later): | |
| 86 | + | |
| 87 | +# i2ctransfer -y 0 w3@0x30 0x03 0x01 0x10 r? | |
| 88 | +0x10 0x0f 0x0e 0x0d 0x0c 0x0b 0x0a 0x09 0x08 0x07 0x06 0x05 0x04 0x03 0x02 0x01 0x00 | |
| @@ -3469,6 +3469,10 @@ EXPORT_SYMBOL_GPL(gpiod_add_lookup_table); · 3468 unmodified lines | ||
| 3469 | 3469 | */ |
| 3470 | 3470 | void gpiod_remove_lookup_table(struct gpiod_lookup_table *table) |
| 3471 | 3471 | { |
| 3472 | + /* Nothing to remove */ | |
| 3473 | + if (!table) | |
| 3474 | + return; | |
| 3475 | + | |
| 3472 | 3476 | mutex_lock(&gpio_lookup_lock); |
| 3473 | 3477 | |
| 3474 | 3478 | list_del(&table->list); |
| @@ -622,9 +622,7 @@ static int bit_xfer_atomic(struct i2c_adapter *i2c_adap, struct i2c_msg msgs[], · 621 unmodified lines | ||
| 622 | 622 | |
| 623 | 623 | static u32 bit_func(struct i2c_adapter *adap) |
| 624 | 624 | { |
| 625 | − return I2C_FUNC_I2C | I2C_FUNC_NOSTART | I2C_FUNC_SMBUS_EMUL | | |
| 626 | − I2C_FUNC_SMBUS_READ_BLOCK_DATA | | |
| 627 | − I2C_FUNC_SMBUS_BLOCK_PROC_CALL | | |
| 625 | + return I2C_FUNC_I2C | I2C_FUNC_NOSTART | I2C_FUNC_SMBUS_EMUL_ALL | | |
| 628 | 626 | I2C_FUNC_10BIT_ADDR | I2C_FUNC_PROTOCOL_MANGLING; |
| 629 | 627 | } |
| 630 | 628 | |
| @@ -586,13 +586,6 @@ config I2C_DIGICOLOR · 585 unmodified lines | ||
| 586 | 586 | This driver can also be built as a module. If so, the module |
| 587 | 587 | will be called i2c-digicolor. |
| 588 | 588 | |
| 589 | −config I2C_EFM32 | |
| 590 | − tristate "EFM32 I2C controller" | |
| 591 | − depends on ARCH_EFM32 || COMPILE_TEST | |
| 592 | − help | |
| 593 | − This driver supports the i2c block found in Energy Micro's EFM32 | |
| 594 | − SoCs. | |
| 595 | − | |
| 596 | 589 | config I2C_EG20T |
| 597 | 590 | tristate "Intel EG20T PCH/LAPIS Semicon IOH(ML7213/ML7223/ML7831) I2C" |
| 598 | 591 | depends on PCI && (X86_32 || MIPS || COMPILE_TEST) |
| @@ -1000,16 +993,6 @@ config I2C_SIMTEC · 401 unmodified lines | ||
| 1000 | 993 | This driver can also be built as a module. If so, the module |
| 1001 | 994 | will be called i2c-simtec. |
| 1002 | 995 | |
| 1003 | −config I2C_SIRF | |
| 1004 | − tristate "CSR SiRFprimaII I2C interface" | |
| 1005 | − depends on ARCH_SIRF || COMPILE_TEST | |
| 1006 | − help | |
| 1007 | − If you say yes to this option, support will be included for the | |
| 1008 | − CSR SiRFprimaII I2C interface. | |
| 1009 | − | |
| 1010 | − This driver can also be built as a module. If so, the module | |
| 1011 | − will be called i2c-sirf. | |
| 1012 | − | |
| 1013 | 996 | config I2C_SPRD |
| 1014 | 997 | tristate "Spreadtrum I2C interface" |
| 1015 | 998 | depends on I2C=y && (ARCH_SPRD || COMPILE_TEST) |
| @@ -1050,19 +1033,6 @@ config I2C_STM32F7 · 34 unmodified lines | ||
| 1050 | 1033 | This driver can also be built as module. If so, the module |
| 1051 | 1034 | will be called i2c-stm32f7. |
| 1052 | 1035 | |
| 1053 | −config I2C_STU300 | |
| 1054 | − tristate "ST Microelectronics DDC I2C interface" | |
| 1055 | − depends on MACH_U300 || COMPILE_TEST | |
| 1056 | − default y if MACH_U300 | |
| 1057 | − help | |
| 1058 | − If you say yes to this option, support will be included for the | |
| 1059 | − I2C interface from ST Microelectronics simply called "DDC I2C" | |
| 1060 | − supporting both I2C and DDC, used in e.g. the U300 series | |
| 1061 | − mobile platforms. | |
| 1062 | − | |
| 1063 | − This driver can also be built as a module. If so, the module | |
| 1064 | − will be called i2c-stu300. | |
| 1065 | − | |
| 1066 | 1036 | config I2C_SUN6I_P2WI |
| 1067 | 1037 | tristate "Allwinner sun6i internal P2WI controller" |
| 1068 | 1038 | depends on RESET_CONTROLLER |
| @@ -1401,15 +1371,6 @@ config I2C_OPAL · 332 unmodified lines | ||
| 1401 | 1371 | This driver can also be built as a module. If so, the module will be |
| 1402 | 1372 | called as i2c-opal. |
| 1403 | 1373 | |
| 1404 | −config I2C_ZX2967 | |
| 1405 | − tristate "ZTE ZX2967 I2C support" | |
| 1406 | − depends on ARCH_ZX | |
| 1407 | − default y | |
| 1408 | − help | |
| 1409 | − Selecting this option will add ZX2967 I2C driver. | |
| 1410 | − This driver can also be built as a module. If so, the module will be | |
| 1411 | − called i2c-zx2967. | |
| 1412 | − | |
| 1413 | 1374 | config I2C_FSI |
| 1414 | 1375 | tristate "FSI I2C driver" |
| 1415 | 1376 | depends on FSI |
| @@ -58,7 +58,6 @@ i2c-designware-platform-$(CONFIG_I2C_DESIGNWARE_BAYTRAIL) += i2c-designware-bayt · 57 unmodified lines | ||
| 58 | 58 | obj-$(CONFIG_I2C_DESIGNWARE_PCI) += i2c-designware-pci.o |
| 59 | 59 | i2c-designware-pci-y := i2c-designware-pcidrv.o |
| 60 | 60 | obj-$(CONFIG_I2C_DIGICOLOR) += i2c-digicolor.o |
| 61 | −obj-$(CONFIG_I2C_EFM32) += i2c-efm32.o | |
| 62 | 61 | obj-$(CONFIG_I2C_EG20T) += i2c-eg20t.o |
| 63 | 62 | obj-$(CONFIG_I2C_EMEV2) += i2c-emev2.o |
| 64 | 63 | obj-$(CONFIG_I2C_EXYNOS5) += i2c-exynos5.o |
| @@ -99,13 +98,11 @@ obj-$(CONFIG_I2C_S3C2410) += i2c-s3c2410.o · 34 unmodified lines | ||
| 99 | 98 | obj-$(CONFIG_I2C_SH7760) += i2c-sh7760.o |
| 100 | 99 | obj-$(CONFIG_I2C_SH_MOBILE) += i2c-sh_mobile.o |
| 101 | 100 | obj-$(CONFIG_I2C_SIMTEC) += i2c-simtec.o |
| 102 | −obj-$(CONFIG_I2C_SIRF) += i2c-sirf.o | |
| 103 | 101 | obj-$(CONFIG_I2C_SPRD) += i2c-sprd.o |
| 104 | 102 | obj-$(CONFIG_I2C_ST) += i2c-st.o |
| 105 | 103 | obj-$(CONFIG_I2C_STM32F4) += i2c-stm32f4.o |
| 106 | 104 | i2c-stm32f7-drv-objs := i2c-stm32f7.o i2c-stm32.o |
| 107 | 105 | obj-$(CONFIG_I2C_STM32F7) += i2c-stm32f7-drv.o |
| 108 | −obj-$(CONFIG_I2C_STU300) += i2c-stu300.o | |
| 109 | 106 | obj-$(CONFIG_I2C_SUN6I_P2WI) += i2c-sun6i-p2wi.o |
| 110 | 107 | obj-$(CONFIG_I2C_SYNQUACER) += i2c-synquacer.o |
| 111 | 108 | obj-$(CONFIG_I2C_TEGRA) += i2c-tegra.o |
| @@ -122,7 +119,6 @@ obj-$(CONFIG_I2C_XILINX) += i2c-xiic.o · 10 unmodified lines | ||
| 122 | 119 | obj-$(CONFIG_I2C_XLR) += i2c-xlr.o |
| 123 | 120 | obj-$(CONFIG_I2C_XLP9XX) += i2c-xlp9xx.o |
| 124 | 121 | obj-$(CONFIG_I2C_RCAR) += i2c-rcar.o |
| 125 | −obj-$(CONFIG_I2C_ZX2967) += i2c-zx2967.o | |
| 126 | 122 | |
| 127 | 123 | # External I2C/SMBus adapter drivers |
| 128 | 124 | obj-$(CONFIG_I2C_DIOLAN_U2C) += i2c-diolan-u2c.o |
| @@ -30,7 +30,7 @@ static void amd_mp2_c2p_mutex_unlock(struct amd_i2c_common *i2c_common) · 29 unmodified lines | ||
| 30 | 30 | struct amd_mp2_dev *privdata = i2c_common->mp2_dev; |
| 31 | 31 | |
| 32 | 32 | if (unlikely(privdata->c2p_lock_busid != i2c_common->bus_id)) { |
| 33 | − dev_warn(ndev_dev(privdata), | |
| 33 | + pci_warn(privdata->pci_dev, | |
| 34 | 34 | "bus %d attempting to unlock C2P locked by bus %d\n", |
| 35 | 35 | i2c_common->bus_id, privdata->c2p_lock_busid); |
| 36 | 36 | return; |
| @@ -59,8 +59,7 @@ int amd_mp2_bus_enable_set(struct amd_i2c_common *i2c_common, bool enable) · 22 unmodified lines | ||
| 59 | 59 | struct amd_mp2_dev *privdata = i2c_common->mp2_dev; |
| 60 | 60 | union i2c_cmd_base i2c_cmd_base; |
| 61 | 61 | |
| 62 | − dev_dbg(ndev_dev(privdata), "%s id: %d\n", __func__, | |
| 63 | − i2c_common->bus_id); | |
| 62 | + pci_dbg(privdata->pci_dev, "id: %d\n", i2c_common->bus_id); | |
| 64 | 63 | |
| 65 | 64 | i2c_cmd_base.ul = 0; |
| 66 | 65 | i2c_cmd_base.s.i2c_cmd = enable ? i2c_enable : i2c_disable; |
| @@ -111,20 +110,19 @@ EXPORT_SYMBOL_GPL(amd_mp2_rw); · 44 unmodified lines | ||
| 111 | 110 | static void amd_mp2_pci_check_rw_event(struct amd_i2c_common *i2c_common) |
| 112 | 111 | { |
| 113 | 112 | struct amd_mp2_dev *privdata = i2c_common->mp2_dev; |
| 113 | + struct pci_dev *pdev = privdata->pci_dev; | |
| 114 | 114 | int len = i2c_common->eventval.r.length; |
| 115 | 115 | u32 slave_addr = i2c_common->eventval.r.slave_addr; |
| 116 | 116 | bool err = false; |
| 117 | 117 | |
| 118 | 118 | if (unlikely(len != i2c_common->msg->len)) { |
| 119 | − dev_err(ndev_dev(privdata), | |
| 120 | − "length %d in event doesn't match buffer length %d!\n", | |
| 119 | + pci_err(pdev, "length %d in event doesn't match buffer length %d!\n", | |
| 121 | 120 | len, i2c_common->msg->len); |
| 122 | 121 | err = true; |
| 123 | 122 | } |
| 124 | 123 | |
| 125 | 124 | if (unlikely(slave_addr != i2c_common->msg->addr)) { |
| 126 | − dev_err(ndev_dev(privdata), | |
| 127 | − "unexpected slave address %x (expected: %x)!\n", | |
| 125 | + pci_err(pdev, "unexpected slave address %x (expected: %x)!\n", | |
| 128 | 126 | slave_addr, i2c_common->msg->addr); |
| 129 | 127 | err = true; |
| 130 | 128 | } |
| @@ -136,13 +134,14 @@ static void amd_mp2_pci_check_rw_event(struct amd_i2c_common *i2c_common) · 5 unmodified lines | ||
| 136 | 134 | static void __amd_mp2_process_event(struct amd_i2c_common *i2c_common) |
| 137 | 135 | { |
| 138 | 136 | struct amd_mp2_dev *privdata = i2c_common->mp2_dev; |
| 137 | + struct pci_dev *pdev = privdata->pci_dev; | |
| 139 | 138 | enum status_type sts = i2c_common->eventval.r.status; |
| 140 | 139 | enum response_type res = i2c_common->eventval.r.response; |
| 141 | 140 | int len = i2c_common->eventval.r.length; |
| 142 | 141 | |
| 143 | 142 | if (res != command_success) { |
| 144 | 143 | if (res != command_failed) |
| 145 | − dev_err(ndev_dev(privdata), "invalid response to i2c command!\n"); | |
| 144 | + pci_err(pdev, "invalid response to i2c command!\n"); | |
| 146 | 145 | return; |
| 147 | 146 | } |
| 148 | 147 | |
| @@ -155,32 +154,26 @@ static void __amd_mp2_process_event(struct amd_i2c_common *i2c_common) · 6 unmodified lines | ||
| 155 | 154 | privdata->mmio + AMD_C2P_MSG2, |
| 156 | 155 | len); |
| 157 | 156 | } else if (sts != i2c_readfail_event) { |
| 158 | − dev_err(ndev_dev(privdata), | |
| 159 | − "invalid i2c status after read (%d)!\n", sts); | |
| 157 | + pci_err(pdev, "invalid i2c status after read (%d)!\n", sts); | |
| 160 | 158 | } |
| 161 | 159 | break; |
| 162 | 160 | case i2c_write: |
| 163 | 161 | if (sts == i2c_writecomplete_event) |
| 164 | 162 | amd_mp2_pci_check_rw_event(i2c_common); |
| 165 | 163 | else if (sts != i2c_writefail_event) |
| 166 | − dev_err(ndev_dev(privdata), | |
| 167 | − "invalid i2c status after write (%d)!\n", sts); | |
| 164 | + pci_err(pdev, "invalid i2c status after write (%d)!\n", sts); | |
| 168 | 165 | break; |
| 169 | 166 | case i2c_enable: |
| 170 | 167 | if (sts == i2c_busenable_complete) |
| 171 | 168 | i2c_common->cmd_success = true; |
| 172 | 169 | else if (sts != i2c_busenable_failed) |
| 173 | − dev_err(ndev_dev(privdata), | |
| 174 | − "invalid i2c status after bus enable (%d)!\n", | |
| 175 | − sts); | |
| 170 | + pci_err(pdev, "invalid i2c status after bus enable (%d)!\n", sts); | |
| 176 | 171 | break; |
| 177 | 172 | case i2c_disable: |
| 178 | 173 | if (sts == i2c_busdisable_complete) |
| 179 | 174 | i2c_common->cmd_success = true; |
| 180 | 175 | else if (sts != i2c_busdisable_failed) |
| 181 | − dev_err(ndev_dev(privdata), | |
| 182 | − "invalid i2c status after bus disable (%d)!\n", | |
| 183 | − sts); | |
| 176 | + pci_err(pdev, "invalid i2c status after bus disable (%d)!\n", sts); | |
| 184 | 177 | break; |
| 185 | 178 | default: |
| 186 | 179 | break; |
| @@ -190,10 +183,10 @@ static void __amd_mp2_process_event(struct amd_i2c_common *i2c_common) · 3 unmodified lines | ||
| 190 | 183 | void amd_mp2_process_event(struct amd_i2c_common *i2c_common) |
| 191 | 184 | { |
| 192 | 185 | struct amd_mp2_dev *privdata = i2c_common->mp2_dev; |
| 186 | + struct pci_dev *pdev = privdata->pci_dev; | |
| 193 | 187 | |
| 194 | 188 | if (unlikely(i2c_common->reqcmd == i2c_none)) { |
| 195 | − dev_warn(ndev_dev(privdata), | |
| 196 | − "received msg but no cmd was sent (bus = %d)!\n", | |
| 189 | + pci_warn(pdev, "received msg but no cmd was sent (bus = %d)!\n", | |
| 197 | 190 | i2c_common->bus_id); |
| 198 | 191 | return; |
| 199 | 192 | } |
| @@ -208,6 +201,7 @@ EXPORT_SYMBOL_GPL(amd_mp2_process_event); · 8 unmodified lines | ||
| 208 | 201 | static irqreturn_t amd_mp2_irq_isr(int irq, void *dev) |
| 209 | 202 | { |
| 210 | 203 | struct amd_mp2_dev *privdata = dev; |
| 204 | + struct pci_dev *pdev = privdata->pci_dev; | |
| 211 | 205 | struct amd_i2c_common *i2c_common; |
| 212 | 206 | u32 val; |
| 213 | 207 | unsigned int bus_id; |
| @@ -236,8 +230,7 @@ static irqreturn_t amd_mp2_irq_isr(int irq, void *dev) · 22 unmodified lines | ||
| 236 | 230 | val = readl(privdata->mmio + AMD_P2C_MSG_INTEN); |
| 237 | 231 | if (val != 0) { |
| 238 | 232 | writel(0, privdata->mmio + AMD_P2C_MSG_INTEN); |
| 239 | − dev_warn(ndev_dev(privdata), | |
| 240 | − "received irq without message\n"); | |
| 233 | + pci_warn(pdev, "received irq without message\n"); | |
| 241 | 234 | ret = IRQ_HANDLED; |
| 242 | 235 | } |
| 243 | 236 | } |
| @@ -255,13 +248,13 @@ EXPORT_SYMBOL_GPL(amd_mp2_rw_timeout); · 11 unmodified lines | ||
| 255 | 248 | int amd_mp2_register_cb(struct amd_i2c_common *i2c_common) |
| 256 | 249 | { |
| 257 | 250 | struct amd_mp2_dev *privdata = i2c_common->mp2_dev; |
| 251 | + struct pci_dev *pdev = privdata->pci_dev; | |
| 258 | 252 | |
| 259 | 253 | if (i2c_common->bus_id > 1) |
| 260 | 254 | return -EINVAL; |
| 261 | 255 | |
| 262 | 256 | if (privdata->busses[i2c_common->bus_id]) { |
| 263 | − dev_err(ndev_dev(privdata), | |
| 264 | − "Bus %d already taken!\n", i2c_common->bus_id); | |
| 257 | + pci_err(pdev, "Bus %d already taken!\n", i2c_common->bus_id); | |
| 265 | 258 | return -EINVAL; |
| 266 | 259 | } |
| 267 | 260 | |
| @@ -301,13 +294,13 @@ static int amd_mp2_pci_init(struct amd_mp2_dev *privdata, · 33 unmodified lines | ||
| 301 | 294 | |
| 302 | 295 | rc = pcim_enable_device(pci_dev); |
| 303 | 296 | if (rc) { |
| 304 | − dev_err(ndev_dev(privdata), "Failed to enable MP2 PCI device\n"); | |
| 297 | + pci_err(pci_dev, "Failed to enable MP2 PCI device\n"); | |
| 305 | 298 | goto err_pci_enable; |
| 306 | 299 | } |
| 307 | 300 | |
| 308 | 301 | rc = pcim_iomap_regions(pci_dev, 1 << 2, pci_name(pci_dev)); |
| 309 | 302 | if (rc) { |
| 310 | − dev_err(ndev_dev(privdata), "I/O memory remapping failed\n"); | |
| 303 | + pci_err(pci_dev, "I/O memory remapping failed\n"); | |
| 311 | 304 | goto err_pci_enable; |
| 312 | 305 | } |
| 313 | 306 | privdata->mmio = pcim_iomap_table(pci_dev)[2]; |
| @@ -327,7 +320,7 @@ static int amd_mp2_pci_init(struct amd_mp2_dev *privdata, · 13 unmodified lines | ||
| 327 | 320 | rc = devm_request_irq(&pci_dev->dev, pci_dev->irq, amd_mp2_irq_isr, |
| 328 | 321 | IRQF_SHARED, dev_name(&pci_dev->dev), privdata); |
| 329 | 322 | if (rc) |
| 330 | − dev_err(&pci_dev->dev, "Failure requesting irq %i: %d\n", | |
| 323 | + pci_err(pci_dev, "Failure requesting irq %i: %d\n", | |
| 331 | 324 | pci_dev->irq, rc); |
| 332 | 325 | |
| 333 | 326 | return rc; |
| @@ -363,7 +356,7 @@ static int amd_mp2_pci_probe(struct pci_dev *pci_dev, · 29 unmodified lines | ||
| 363 | 356 | |
| 364 | 357 | privdata->probed = true; |
| 365 | 358 | |
| 366 | − dev_info(&pci_dev->dev, "MP2 device registered.\n"); | |
| 359 | + pci_info(pci_dev, "MP2 device registered.\n"); | |
| 367 | 360 | return 0; |
| 368 | 361 | } |
| 369 | 362 | |
| @@ -397,8 +390,7 @@ static int amd_mp2_pci_suspend(struct device *dev) · 27 unmodified lines | ||
| 397 | 390 | |
| 398 | 391 | ret = pci_save_state(pci_dev); |
| 399 | 392 | if (ret) { |
| 400 | − dev_err(ndev_dev(privdata), | |
| 401 | − "pci_save_state failed = %d\n", ret); | |
| 393 | + pci_err(pci_dev, "pci_save_state failed = %d\n", ret); | |
| 402 | 394 | return ret; |
| 403 | 395 | } |
| 404 | 396 | |
| @@ -417,8 +409,7 @@ static int amd_mp2_pci_resume(struct device *dev) · 12 unmodified lines | ||
| 417 | 409 | pci_restore_state(pci_dev); |
| 418 | 410 | ret = pci_enable_device(pci_dev); |
| 419 | 411 | if (ret < 0) { |
| 420 | − dev_err(ndev_dev(privdata), | |
| 421 | − "pci_enable_device failed = %d\n", ret); | |
| 412 | + pci_err(pci_dev, "pci_enable_device failed = %d\n", ret); | |
| 422 | 413 | return ret; |
| 423 | 414 | } |
| 424 | 415 | |
| @@ -88,8 +88,7 @@ static void i2c_amd_cmd_completion(struct amd_i2c_common *i2c_common) · 87 unmodified lines | ||
| 88 | 88 | union i2c_event *event = &i2c_common->eventval; |
| 89 | 89 | |
| 90 | 90 | if (event->r.status == i2c_readcomplete_event) |
| 91 | − dev_dbg(&i2c_dev->pdev->dev, "%s readdata:%*ph\n", | |
| 92 | − __func__, event->r.length, | |
| 91 | + dev_dbg(&i2c_dev->pdev->dev, "readdata:%*ph\n", event->r.length, | |
| 93 | 92 | i2c_common->msg->buf); |
| 94 | 93 | |
| 95 | 94 | complete(&i2c_dev->cmd_complete); |
| @@ -185,12 +185,6 @@ struct amd_mp2_dev { · 184 unmodified lines | ||
| 185 | 185 | unsigned int probed; |
| 186 | 186 | }; |
| 187 | 187 | |
| 188 | −#define ndev_pdev(ndev) ((ndev)->pci_dev) | |
| 189 | −#define ndev_name(ndev) pci_name(ndev_pdev(ndev)) | |
| 190 | −#define ndev_dev(ndev) (&ndev_pdev(ndev)->dev) | |
| 191 | −#define work_amd_i2c_common(__work) \ | |
| 192 | − container_of(__work, struct amd_i2c_common, work.work) | |
| 193 | − | |
| 194 | 188 | /* PCIe communication driver */ |
| 195 | 189 | |
| 196 | 190 | int amd_mp2_rw(struct amd_i2c_common *i2c_common, enum i2c_cmd reqcmd); |
| @@ -93,6 +93,7 @@ · 92 unmodified lines | ||
| 93 | 93 | #define S_CMD_STATUS_MASK 0x07 |
| 94 | 94 | #define S_CMD_STATUS_SUCCESS 0x0 |
| 95 | 95 | #define S_CMD_STATUS_TIMEOUT 0x5 |
| 96 | +#define S_CMD_STATUS_MASTER_ABORT 0x7 | |
| 96 | 97 | |
| 97 | 98 | #define IE_OFFSET 0x38 |
| 98 | 99 | #define IE_M_RX_FIFO_FULL_SHIFT 31 |
| @@ -159,6 +160,11 @@ · 60 unmodified lines | ||
| 159 | 160 | |
| 160 | 161 | #define IE_S_ALL_INTERRUPT_SHIFT 21 |
| 161 | 162 | #define IE_S_ALL_INTERRUPT_MASK 0x3f |
| 163 | +/* | |
| 164 | + * It takes ~18us to reading 10bytes of data, hence to keep tasklet | |
| 165 | + * running for less time, max slave read per tasklet is set to 10 bytes. | |
| 166 | + */ | |
| 167 | +#define MAX_SLAVE_RX_PER_INT 10 | |
| 162 | 168 | |
| 163 | 169 | enum i2c_slave_read_status { |
| 164 | 170 | I2C_SLAVE_RX_FIFO_EMPTY = 0, |
| @@ -205,8 +211,18 @@ struct bcm_iproc_i2c_dev { · 40 unmodified lines | ||
| 205 | 211 | /* bytes that have been read */ |
| 206 | 212 | unsigned int rx_bytes; |
| 207 | 213 | unsigned int thld_bytes; |
| 214 | + | |
| 215 | + bool slave_rx_only; | |
| 216 | + bool rx_start_rcvd; | |
| 217 | + bool slave_read_complete; | |
| 218 | + u32 tx_underrun; | |
| 219 | + u32 slave_int_mask; | |
| 220 | + struct tasklet_struct slave_rx_tasklet; | |
| 208 | 221 | }; |
| 209 | 222 | |
| 223 | +/* tasklet to process slave rx data */ | |
| 224 | +static void slave_rx_tasklet_fn(unsigned long); | |
| 225 | + | |
| 210 | 226 | /* |
| 211 | 227 | * Can be expanded in the future if more interrupt status bits are utilized |
| 212 | 228 | */ |
| @@ -215,7 +231,8 @@ struct bcm_iproc_i2c_dev { · 2 unmodified lines | ||
| 215 | 231 | |
| 216 | 232 | #define ISR_MASK_SLAVE (BIT(IS_S_START_BUSY_SHIFT)\ |
| 217 | 233 | | BIT(IS_S_RX_EVENT_SHIFT) | BIT(IS_S_RD_EVENT_SHIFT)\ |
| 218 | − | BIT(IS_S_TX_UNDERRUN_SHIFT)) | |
| 234 | + | BIT(IS_S_TX_UNDERRUN_SHIFT) | BIT(IS_S_RX_FIFO_FULL_SHIFT)\ | |
| 235 | + | BIT(IS_S_RX_THLD_SHIFT)) | |
| 219 | 236 | |
| 220 | 237 | static int bcm_iproc_i2c_reg_slave(struct i2c_client *slave); |
| 221 | 238 | static int bcm_iproc_i2c_unreg_slave(struct i2c_client *slave); |
| @@ -259,6 +276,7 @@ static void bcm_iproc_i2c_slave_init( · 37 unmodified lines | ||
| 259 | 276 | { |
| 260 | 277 | u32 val; |
| 261 | 278 | |
| 279 | + iproc_i2c->tx_underrun = 0; | |
| 262 | 280 | if (need_reset) { |
| 263 | 281 | /* put controller in reset */ |
| 264 | 282 | val = iproc_i2c_rd_reg(iproc_i2c, CFG_OFFSET); |
| @@ -295,8 +313,13 @@ static void bcm_iproc_i2c_slave_init( · 30 unmodified lines | ||
| 295 | 313 | |
| 296 | 314 | /* Enable interrupt register to indicate a valid byte in receive fifo */ |
| 297 | 315 | val = BIT(IE_S_RX_EVENT_SHIFT); |
| 316 | + /* Enable interrupt register to indicate Slave Rx FIFO Full */ | |
| 317 | + val |= BIT(IE_S_RX_FIFO_FULL_SHIFT); | |
| 318 | + /* Enable interrupt register to indicate a Master read transaction */ | |
| 319 | + val |= BIT(IE_S_RD_EVENT_SHIFT); | |
| 298 | 320 | /* Enable interrupt register for the Slave BUSY command */ |
| 299 | 321 | val |= BIT(IE_S_START_BUSY_SHIFT); |
| 322 | + iproc_i2c->slave_int_mask = val; | |
| 300 | 323 | iproc_i2c_wr_reg(iproc_i2c, IE_OFFSET, val); |
| 301 | 324 | } |
| 302 | 325 | |
| @@ -311,9 +334,10 @@ static void bcm_iproc_i2c_check_slave_status( · 8 unmodified lines | ||
| 311 | 334 | return; |
| 312 | 335 | |
| 313 | 336 | val = (val >> S_CMD_STATUS_SHIFT) & S_CMD_STATUS_MASK; |
| 314 | − if (val == S_CMD_STATUS_TIMEOUT) { | |
| 315 | − dev_err(iproc_i2c->device, "slave random stretch time timeout\n"); | |
| 316 | − | |
| 337 | + if (val == S_CMD_STATUS_TIMEOUT || val == S_CMD_STATUS_MASTER_ABORT) { | |
| 338 | + dev_err(iproc_i2c->device, (val == S_CMD_STATUS_TIMEOUT) ? | |
| 339 | + "slave random stretch time timeout\n" : | |
| 340 | + "Master aborted read transaction\n"); | |
| 317 | 341 | /* re-initialize i2c for recovery */ |
| 318 | 342 | bcm_iproc_i2c_enable_disable(iproc_i2c, false); |
| 319 | 343 | bcm_iproc_i2c_slave_init(iproc_i2c, true); |
| @@ -321,76 +345,187 @@ static void bcm_iproc_i2c_check_slave_status( · 1 unmodified line | ||
| 321 | 345 | } |
| 322 | 346 | } |
| 323 | 347 | |
| 324 | −static bool bcm_iproc_i2c_slave_isr(struct bcm_iproc_i2c_dev *iproc_i2c, | |
| 325 | − u32 status) | |
| 348 | +static void bcm_iproc_i2c_slave_read(struct bcm_iproc_i2c_dev *iproc_i2c) | |
| 326 | 349 | { |
| 350 | + u8 rx_data, rx_status; | |
| 351 | + u32 rx_bytes = 0; | |
| 327 | 352 | u32 val; |
| 328 | − u8 value, rx_status; | |
| 329 | 353 | |
| 330 | − /* Slave RX byte receive */ | |
| 331 | − if (status & BIT(IS_S_RX_EVENT_SHIFT)) { | |
| 354 | + while (rx_bytes < MAX_SLAVE_RX_PER_INT) { | |
| 332 | 355 | val = iproc_i2c_rd_reg(iproc_i2c, S_RX_OFFSET); |
| 333 | 356 | rx_status = (val >> S_RX_STATUS_SHIFT) & S_RX_STATUS_MASK; |
| 334 | − if (rx_status == I2C_SLAVE_RX_START) { | |
| 335 | − /* Start of SMBUS for Master write */ | |
| 336 | − i2c_slave_event(iproc_i2c->slave, | |
| 337 | − I2C_SLAVE_WRITE_REQUESTED, &value); | |
| 357 | + rx_data = ((val >> S_RX_DATA_SHIFT) & S_RX_DATA_MASK); | |
| 338 | 358 | |
| 339 | − val = iproc_i2c_rd_reg(iproc_i2c, S_RX_OFFSET); | |
| 340 | − value = (u8)((val >> S_RX_DATA_SHIFT) & S_RX_DATA_MASK); | |
| 359 | + if (rx_status == I2C_SLAVE_RX_START) { | |
| 360 | + /* Start of SMBUS Master write */ | |
| 341 | 361 | i2c_slave_event(iproc_i2c->slave, |
| 342 | − I2C_SLAVE_WRITE_RECEIVED, &value); | |
| 343 | − } else if (status & BIT(IS_S_RD_EVENT_SHIFT)) { | |
| 344 | − /* Start of SMBUS for Master Read */ | |
| 362 | + I2C_SLAVE_WRITE_REQUESTED, &rx_data); | |
| 363 | + iproc_i2c->rx_start_rcvd = true; | |
| 364 | + iproc_i2c->slave_read_complete = false; | |
| 365 | + } else if (rx_status == I2C_SLAVE_RX_DATA && | |
| 366 | + iproc_i2c->rx_start_rcvd) { | |
| 367 | + /* Middle of SMBUS Master write */ | |
| 345 | 368 | i2c_slave_event(iproc_i2c->slave, |
| 346 | − I2C_SLAVE_READ_REQUESTED, &value); | |
| 347 | − iproc_i2c_wr_reg(iproc_i2c, S_TX_OFFSET, value); | |
| 369 | + I2C_SLAVE_WRITE_RECEIVED, &rx_data); | |
| 370 | + } else if (rx_status == I2C_SLAVE_RX_END && | |
| 371 | + iproc_i2c->rx_start_rcvd) { | |
| 372 | + /* End of SMBUS Master write */ | |
| 373 | + if (iproc_i2c->slave_rx_only) | |
| 374 | + i2c_slave_event(iproc_i2c->slave, | |
| 375 | + I2C_SLAVE_WRITE_RECEIVED, | |
| 376 | + &rx_data); | |
| 377 | + | |
| 378 | + i2c_slave_event(iproc_i2c->slave, I2C_SLAVE_STOP, | |
| 379 | + &rx_data); | |
| 380 | + } else if (rx_status == I2C_SLAVE_RX_FIFO_EMPTY) { | |
| 381 | + iproc_i2c->rx_start_rcvd = false; | |
| 382 | + iproc_i2c->slave_read_complete = true; | |
| 383 | + break; | |
| 384 | + } | |
| 348 | 385 | |
| 349 | − val = BIT(S_CMD_START_BUSY_SHIFT); | |
| 350 | − iproc_i2c_wr_reg(iproc_i2c, S_CMD_OFFSET, val); | |
| 386 | + rx_bytes++; | |
| 387 | + } | |
| 388 | +} | |
| 351 | 389 | |
| 352 | − /* | |
| 353 | − * Enable interrupt for TX FIFO becomes empty and | |
| 354 | − * less than PKT_LENGTH bytes were output on the SMBUS | |
| 355 | − */ | |
| 356 | − val = iproc_i2c_rd_reg(iproc_i2c, IE_OFFSET); | |
| 357 | − val |= BIT(IE_S_TX_UNDERRUN_SHIFT); | |
| 358 | − iproc_i2c_wr_reg(iproc_i2c, IE_OFFSET, val); | |
| 359 | − } else { | |
| 360 | − /* Master write other than start */ | |
| 361 | − value = (u8)((val >> S_RX_DATA_SHIFT) & S_RX_DATA_MASK); | |
| 390 | +static void slave_rx_tasklet_fn(unsigned long data) | |
| 391 | +{ | |
| 392 | + struct bcm_iproc_i2c_dev *iproc_i2c = (struct bcm_iproc_i2c_dev *)data; | |
| 393 | + u32 int_clr; | |
| 394 | + | |
| 395 | + bcm_iproc_i2c_slave_read(iproc_i2c); | |
| 396 | + | |
| 397 | + /* clear pending IS_S_RX_EVENT_SHIFT interrupt */ | |
| 398 | + int_clr = BIT(IS_S_RX_EVENT_SHIFT); | |
| 399 | + | |
| 400 | + if (!iproc_i2c->slave_rx_only && iproc_i2c->slave_read_complete) { | |
| 401 | + /* | |
| 402 | + * In case of single byte master-read request, | |
| 403 | + * IS_S_TX_UNDERRUN_SHIFT event is generated before | |
| 404 | + * IS_S_START_BUSY_SHIFT event. Hence start slave data send | |
| 405 | + * from first IS_S_TX_UNDERRUN_SHIFT event. | |
| 406 | + * | |
| 407 | + * This means don't send any data from slave when | |
| 408 | + * IS_S_RD_EVENT_SHIFT event is generated else it will increment | |
| 409 | + * eeprom or other backend slave driver read pointer twice. | |
| 410 | + */ | |
| 411 | + iproc_i2c->tx_underrun = 0; | |
| 412 | + iproc_i2c->slave_int_mask |= BIT(IE_S_TX_UNDERRUN_SHIFT); | |
| 413 | + | |
| 414 | + /* clear IS_S_RD_EVENT_SHIFT interrupt */ | |
| 415 | + int_clr |= BIT(IS_S_RD_EVENT_SHIFT); | |
| 416 | + } | |
| 417 | + | |
| 418 | + /* clear slave interrupt */ | |
| 419 | + iproc_i2c_wr_reg(iproc_i2c, IS_OFFSET, int_clr); | |
| 420 | + /* enable slave interrupts */ | |
| 421 | + iproc_i2c_wr_reg(iproc_i2c, IE_OFFSET, iproc_i2c->slave_int_mask); | |
| 422 | +} | |
| 423 | + | |
| 424 | +static bool bcm_iproc_i2c_slave_isr(struct bcm_iproc_i2c_dev *iproc_i2c, | |
| 425 | + u32 status) | |
| 426 | +{ | |
| 427 | + u32 val; | |
| 428 | + u8 value; | |
| 429 | + | |
| 430 | + /* | |
| 431 | + * Slave events in case of master-write, master-write-read and, | |
| 432 | + * master-read | |
| 433 | + * | |
| 434 | + * Master-write : only IS_S_RX_EVENT_SHIFT event | |
| 435 | + * Master-write-read: both IS_S_RX_EVENT_SHIFT and IS_S_RD_EVENT_SHIFT | |
| 436 | + * events | |
| 437 | + * Master-read : both IS_S_RX_EVENT_SHIFT and IS_S_RD_EVENT_SHIFT | |
| 438 | + * events or only IS_S_RD_EVENT_SHIFT | |
| 439 | + * | |
| 440 | + * iproc has a slave rx fifo size of 64 bytes. Rx fifo full interrupt | |
| 441 | + * (IS_S_RX_FIFO_FULL_SHIFT) will be generated when RX fifo becomes | |
| 442 | + * full. This can happen if Master issues write requests of more than | |
| 443 | + * 64 bytes. | |
| 444 | + */ | |
| 445 | + if (status & BIT(IS_S_RX_EVENT_SHIFT) || | |
| 446 | + status & BIT(IS_S_RD_EVENT_SHIFT) || | |
| 447 | + status & BIT(IS_S_RX_FIFO_FULL_SHIFT)) { | |
| 448 | + /* disable slave interrupts */ | |
| 449 | + val = iproc_i2c_rd_reg(iproc_i2c, IE_OFFSET); | |
| 450 | + val &= ~iproc_i2c->slave_int_mask; | |
| 451 | + iproc_i2c_wr_reg(iproc_i2c, IE_OFFSET, val); | |
| 452 | + | |
| 453 | + if (status & BIT(IS_S_RD_EVENT_SHIFT)) | |
| 454 | + /* Master-write-read request */ | |
| 455 | + iproc_i2c->slave_rx_only = false; | |
| 456 | + else | |
| 457 | + /* Master-write request only */ | |
| 458 | + iproc_i2c->slave_rx_only = true; | |
| 459 | + | |
| 460 | + /* schedule tasklet to read data later */ | |
| 461 | + tasklet_schedule(&iproc_i2c->slave_rx_tasklet); | |
| 462 | + | |
| 463 | + /* | |
| 464 | + * clear only IS_S_RX_EVENT_SHIFT and | |
| 465 | + * IS_S_RX_FIFO_FULL_SHIFT interrupt. | |
| 466 | + */ | |
| 467 | + val = BIT(IS_S_RX_EVENT_SHIFT); | |
| 468 | + if (status & BIT(IS_S_RX_FIFO_FULL_SHIFT)) | |
| 469 | + val |= BIT(IS_S_RX_FIFO_FULL_SHIFT); | |
| 470 | + iproc_i2c_wr_reg(iproc_i2c, IS_OFFSET, val); | |
| 471 | + } | |
| 472 | + | |
| 473 | + if (status & BIT(IS_S_TX_UNDERRUN_SHIFT)) { | |
| 474 | + iproc_i2c->tx_underrun++; | |
| 475 | + if (iproc_i2c->tx_underrun == 1) | |
| 476 | + /* Start of SMBUS for Master Read */ | |
| 362 | 477 | i2c_slave_event(iproc_i2c->slave, |
| 363 | − I2C_SLAVE_WRITE_RECEIVED, &value); | |
| 364 | − if (rx_status == I2C_SLAVE_RX_END) | |
| 365 | − i2c_slave_event(iproc_i2c->slave, | |
| 366 | − I2C_SLAVE_STOP, &value); | |
| 367 | − } | |
| 368 | − } else if (status & BIT(IS_S_TX_UNDERRUN_SHIFT)) { | |
| 369 | − /* Master read other than start */ | |
| 370 | − i2c_slave_event(iproc_i2c->slave, | |
| 371 | − I2C_SLAVE_READ_PROCESSED, &value); | |
| 478 | + I2C_SLAVE_READ_REQUESTED, | |
| 479 | + &value); | |
| 480 | + else | |
| 481 | + /* Master read other than start */ | |
| 482 | + i2c_slave_event(iproc_i2c->slave, | |
| 483 | + I2C_SLAVE_READ_PROCESSED, | |
| 484 | + &value); | |
| 372 | 485 | |
| 373 | 486 | iproc_i2c_wr_reg(iproc_i2c, S_TX_OFFSET, value); |
| 487 | + /* start transfer */ | |
| 374 | 488 | val = BIT(S_CMD_START_BUSY_SHIFT); |
| 375 | 489 | iproc_i2c_wr_reg(iproc_i2c, S_CMD_OFFSET, val); |
| 490 | + | |
| 491 | + /* clear interrupt */ | |
| 492 | + iproc_i2c_wr_reg(iproc_i2c, IS_OFFSET, | |
| 493 | + BIT(IS_S_TX_UNDERRUN_SHIFT)); | |
| 376 | 494 | } |
| 377 | 495 | |
| 378 | − /* Stop */ | |
| 496 | + /* Stop received from master in case of master read transaction */ | |
| 379 | 497 | if (status & BIT(IS_S_START_BUSY_SHIFT)) { |
| 380 | − i2c_slave_event(iproc_i2c->slave, I2C_SLAVE_STOP, &value); | |
| 381 | 498 | /* |
| 382 | − * Enable interrupt for TX FIFO becomes empty and | |
| 499 | + * Disable interrupt for TX FIFO becomes empty and | |
| 383 | 500 | * less than PKT_LENGTH bytes were output on the SMBUS |
| 384 | 501 | */ |
| 385 | − val = iproc_i2c_rd_reg(iproc_i2c, IE_OFFSET); | |
| 386 | − val &= ~BIT(IE_S_TX_UNDERRUN_SHIFT); | |
| 387 | − iproc_i2c_wr_reg(iproc_i2c, IE_OFFSET, val); | |
| 502 | + iproc_i2c->slave_int_mask &= ~BIT(IE_S_TX_UNDERRUN_SHIFT); | |
| 503 | + iproc_i2c_wr_reg(iproc_i2c, IE_OFFSET, | |
| 504 | + iproc_i2c->slave_int_mask); | |
| 505 | + | |
| 506 | + /* End of SMBUS for Master Read */ | |
| 507 | + val = BIT(S_TX_WR_STATUS_SHIFT); | |
| 508 | + iproc_i2c_wr_reg(iproc_i2c, S_TX_OFFSET, val); | |
| 509 | + | |
| 510 | + val = BIT(S_CMD_START_BUSY_SHIFT); | |
| 511 | + iproc_i2c_wr_reg(iproc_i2c, S_CMD_OFFSET, val); | |
| 512 | + | |
| 513 | + /* flush TX FIFOs */ | |
| 514 | + val = iproc_i2c_rd_reg(iproc_i2c, S_FIFO_CTRL_OFFSET); | |
| 515 | + val |= (BIT(S_FIFO_TX_FLUSH_SHIFT)); | |
| 516 | + iproc_i2c_wr_reg(iproc_i2c, S_FIFO_CTRL_OFFSET, val); | |
| 517 | + | |
| 518 | + i2c_slave_event(iproc_i2c->slave, I2C_SLAVE_STOP, &value); | |
| 519 | + | |
| 520 | + /* clear interrupt */ | |
| 521 | + iproc_i2c_wr_reg(iproc_i2c, IS_OFFSET, | |
| 522 | + BIT(IS_S_START_BUSY_SHIFT)); | |
| 388 | 523 | } |
| 389 | 524 | |
| 390 | − /* clear interrupt status */ | |
| 391 | − iproc_i2c_wr_reg(iproc_i2c, IS_OFFSET, status); | |
| 525 | + /* check slave transmit status only if slave is transmitting */ | |
| 526 | + if (!iproc_i2c->slave_rx_only) | |
| 527 | + bcm_iproc_i2c_check_slave_status(iproc_i2c); | |
| 392 | 528 | |
| 393 | − bcm_iproc_i2c_check_slave_status(iproc_i2c); | |
| 394 | 529 | return true; |
| 395 | 530 | } |
| 396 | 531 | |
| @@ -505,12 +640,17 @@ static void bcm_iproc_i2c_process_m_event(struct bcm_iproc_i2c_dev *iproc_i2c, · 108 unmodified lines | ||
| 505 | 640 | static irqreturn_t bcm_iproc_i2c_isr(int irq, void *data) |
| 506 | 641 | { |
| 507 | 642 | struct bcm_iproc_i2c_dev *iproc_i2c = data; |
| 508 | − u32 status = iproc_i2c_rd_reg(iproc_i2c, IS_OFFSET); | |
| 643 | + u32 slave_status; | |
| 644 | + u32 status; | |
| 509 | 645 | bool ret; |
| 510 | − u32 sl_status = status & ISR_MASK_SLAVE; | |
| 511 | 646 | |
| 512 | − if (sl_status) { | |
| 513 | − ret = bcm_iproc_i2c_slave_isr(iproc_i2c, sl_status); | |
| 647 | + status = iproc_i2c_rd_reg(iproc_i2c, IS_OFFSET); | |
| 648 | + /* process only slave interrupt which are enabled */ | |
| 649 | + slave_status = status & iproc_i2c_rd_reg(iproc_i2c, IE_OFFSET) & | |
| 650 | + ISR_MASK_SLAVE; | |
| 651 | + | |
| 652 | + if (slave_status) { | |
| 653 | + ret = bcm_iproc_i2c_slave_isr(iproc_i2c, slave_status); | |
| 514 | 654 | if (ret) |
| 515 | 655 | return IRQ_HANDLED; |
| 516 | 656 | else |
| @@ -1066,6 +1206,10 @@ static int bcm_iproc_i2c_reg_slave(struct i2c_client *slave) · 549 unmodified lines | ||
| 1066 | 1206 | return -EAFNOSUPPORT; |
| 1067 | 1207 | |
| 1068 | 1208 | iproc_i2c->slave = slave; |
| 1209 | + | |
| 1210 | + tasklet_init(&iproc_i2c->slave_rx_tasklet, slave_rx_tasklet_fn, | |
| 1211 | + (unsigned long)iproc_i2c); | |
| 1212 | + | |
| 1069 | 1213 | bcm_iproc_i2c_slave_init(iproc_i2c, false); |
| 1070 | 1214 | return 0; |
| 1071 | 1215 | } |
| @@ -1086,6 +1230,8 @@ static int bcm_iproc_i2c_unreg_slave(struct i2c_client *slave) · 14 unmodified lines | ||
| 1086 | 1230 | IE_S_ALL_INTERRUPT_SHIFT); |
| 1087 | 1231 | iproc_i2c_wr_reg(iproc_i2c, IE_OFFSET, tmp); |
| 1088 | 1232 | |
| 1233 | + tasklet_kill(&iproc_i2c->slave_rx_tasklet); | |
| 1234 | + | |
| 1089 | 1235 | /* Erase the slave address programmed */ |
| 1090 | 1236 | tmp = iproc_i2c_rd_reg(iproc_i2c, S_CFG_SMBUS_ADDR_OFFSET); |
| 1091 | 1237 | tmp &= ~BIT(S_CFG_EN_NIC_SMB_ADDR3_SHIFT); |
| @@ -160,12 +160,11 @@ static irqreturn_t dc_i2c_irq(int irq, void *dev_id) · 159 unmodified lines | ||
| 160 | 160 | { |
| 161 | 161 | struct dc_i2c *i2c = dev_id; |
| 162 | 162 | int cmd_status = dc_i2c_cmd_status(i2c); |
| 163 | − unsigned long flags; | |
| 164 | 163 | u8 addr_cmd; |
| 165 | 164 | |
| 166 | 165 | writeb_relaxed(1, i2c->regs + II_INTFLAG_CLEAR); |
| 167 | 166 | |
| 168 | − spin_lock_irqsave(&i2c->lock, flags); | |
| 167 | + spin_lock(&i2c->lock); | |
| 169 | 168 | |
| 170 | 169 | if (cmd_status == II_CMD_STATUS_ACK_BAD |
| 171 | 170 | || cmd_status == II_CMD_STATUS_ABORT) { |
| @@ -207,7 +206,7 @@ static irqreturn_t dc_i2c_irq(int irq, void *dev_id) · 35 unmodified lines | ||
| 207 | 206 | } |
| 208 | 207 | |
| 209 | 208 | out: |
| 210 | − spin_unlock_irqrestore(&i2c->lock, flags); | |
| 209 | + spin_unlock(&i2c->lock); | |
| 211 | 210 | return IRQ_HANDLED; |
| 212 | 211 | } |
| 213 | 212 | |
| @@ -1,469 +0,0 @@ | ||
| 1 | −// SPDX-License-Identifier: GPL-2.0-only | |
| 2 | −/* | |
| 3 | − * Copyright (C) 2014 Uwe Kleine-Koenig for Pengutronix | |
| 4 | − */ | |
| 5 | −#include <linux/module.h> | |
| 6 | −#include <linux/platform_device.h> | |
| 7 | −#include <linux/i2c.h> | |
| 8 | −#include <linux/io.h> | |
| 9 | −#include <linux/interrupt.h> | |
| 10 | −#include <linux/err.h> | |
| 11 | −#include <linux/clk.h> | |
| 12 | − | |
| 13 | −#define DRIVER_NAME "efm32-i2c" | |
| 14 | − | |
| 15 | −#define MASK_VAL(mask, val) ((val << __ffs(mask)) & mask) | |
| 16 | − | |
| 17 | −#define REG_CTRL 0x00 | |
| 18 | −#define REG_CTRL_EN 0x00001 | |
| 19 | −#define REG_CTRL_SLAVE 0x00002 | |
| 20 | −#define REG_CTRL_AUTOACK 0x00004 | |
| 21 | −#define REG_CTRL_AUTOSE 0x00008 | |
| 22 | −#define REG_CTRL_AUTOSN 0x00010 | |
| 23 | −#define REG_CTRL_ARBDIS 0x00020 | |
| 24 | −#define REG_CTRL_GCAMEN 0x00040 | |
| 25 | −#define REG_CTRL_CLHR__MASK 0x00300 | |
| 26 | −#define REG_CTRL_BITO__MASK 0x03000 | |
| 27 | −#define REG_CTRL_BITO_OFF 0x00000 | |
| 28 | −#define REG_CTRL_BITO_40PCC 0x01000 | |
| 29 | −#define REG_CTRL_BITO_80PCC 0x02000 | |
| 30 | −#define REG_CTRL_BITO_160PCC 0x03000 | |
| 31 | −#define REG_CTRL_GIBITO 0x08000 | |
| 32 | −#define REG_CTRL_CLTO__MASK 0x70000 | |
| 33 | −#define REG_CTRL_CLTO_OFF 0x00000 | |
| 34 | − | |
| 35 | −#define REG_CMD 0x04 | |
| 36 | −#define REG_CMD_START 0x00001 | |
| 37 | −#define REG_CMD_STOP 0x00002 | |
| 38 | −#define REG_CMD_ACK 0x00004 | |
| 39 | −#define REG_CMD_NACK 0x00008 | |
| 40 | −#define REG_CMD_CONT 0x00010 | |
| 41 | −#define REG_CMD_ABORT 0x00020 | |
| 42 | −#define REG_CMD_CLEARTX 0x00040 | |
| 43 | −#define REG_CMD_CLEARPC 0x00080 | |
| 44 | − | |
| 45 | −#define REG_STATE 0x08 | |
| 46 | −#define REG_STATE_BUSY 0x00001 | |
| 47 | −#define REG_STATE_MASTER 0x00002 | |
| 48 | −#define REG_STATE_TRANSMITTER 0x00004 | |
| 49 | −#define REG_STATE_NACKED 0x00008 | |
| 50 | −#define REG_STATE_BUSHOLD 0x00010 | |
| 51 | −#define REG_STATE_STATE__MASK 0x000e0 | |
| 52 | −#define REG_STATE_STATE_IDLE 0x00000 | |
| 53 | −#define REG_STATE_STATE_WAIT 0x00020 | |
| 54 | −#define REG_STATE_STATE_START 0x00040 | |
| 55 | −#define REG_STATE_STATE_ADDR 0x00060 | |
| 56 | −#define REG_STATE_STATE_ADDRACK 0x00080 | |
| 57 | −#define REG_STATE_STATE_DATA 0x000a0 | |
| 58 | −#define REG_STATE_STATE_DATAACK 0x000c0 | |
| 59 | − | |
| 60 | −#define REG_STATUS 0x0c | |
| 61 | −#define REG_STATUS_PSTART 0x00001 | |
| 62 | −#define REG_STATUS_PSTOP 0x00002 | |
| 63 | −#define REG_STATUS_PACK 0x00004 | |
| 64 | −#define REG_STATUS_PNACK 0x00008 | |
| 65 | −#define REG_STATUS_PCONT 0x00010 | |
| 66 | −#define REG_STATUS_PABORT 0x00020 | |
| 67 | −#define REG_STATUS_TXC 0x00040 | |
| 68 | −#define REG_STATUS_TXBL 0x00080 | |
| 69 | −#define REG_STATUS_RXDATAV 0x00100 | |
| 70 | − | |
| 71 | −#define REG_CLKDIV 0x10 | |
| 72 | −#define REG_CLKDIV_DIV__MASK 0x001ff | |
| 73 | −#define REG_CLKDIV_DIV(div) MASK_VAL(REG_CLKDIV_DIV__MASK, (div)) | |
| 74 | − | |
| 75 | −#define REG_SADDR 0x14 | |
| 76 | −#define REG_SADDRMASK 0x18 | |
| 77 | −#define REG_RXDATA 0x1c | |
| 78 | −#define REG_RXDATAP 0x20 | |
| 79 | −#define REG_TXDATA 0x24 | |
| 80 | −#define REG_IF 0x28 | |
| 81 | −#define REG_IF_START 0x00001 | |
| 82 | −#define REG_IF_RSTART 0x00002 | |
| 83 | −#define REG_IF_ADDR 0x00004 | |
| 84 | −#define REG_IF_TXC 0x00008 | |
| 85 | −#define REG_IF_TXBL 0x00010 | |
| 86 | −#define REG_IF_RXDATAV 0x00020 | |
| 87 | −#define REG_IF_ACK 0x00040 | |
| 88 | −#define REG_IF_NACK 0x00080 | |
| 89 | −#define REG_IF_MSTOP 0x00100 | |
| 90 | −#define REG_IF_ARBLOST 0x00200 | |
| 91 | −#define REG_IF_BUSERR 0x00400 | |
| 92 | −#define REG_IF_BUSHOLD 0x00800 | |
| 93 | −#define REG_IF_TXOF 0x01000 | |
| 94 | −#define REG_IF_RXUF 0x02000 | |
| 95 | −#define REG_IF_BITO 0x04000 | |
| 96 | −#define REG_IF_CLTO 0x08000 | |
| 97 | −#define REG_IF_SSTOP 0x10000 | |
| 98 | − | |
| 99 | −#define REG_IFS 0x2c | |
| 100 | −#define REG_IFC 0x30 | |
| 101 | −#define REG_IFC__MASK 0x1ffcf | |
| 102 | − | |
| 103 | −#define REG_IEN 0x34 | |
| 104 | − | |
| 105 | −#define REG_ROUTE 0x38 | |
| 106 | −#define REG_ROUTE_SDAPEN 0x00001 | |
| 107 | −#define REG_ROUTE_SCLPEN 0x00002 | |
| 108 | −#define REG_ROUTE_LOCATION__MASK 0x00700 | |
| 109 | −#define REG_ROUTE_LOCATION(n) MASK_VAL(REG_ROUTE_LOCATION__MASK, (n)) | |
| 110 | − | |
| 111 | −struct efm32_i2c_ddata { | |
| 112 | − struct i2c_adapter adapter; | |
| 113 | − | |
| 114 | − struct clk *clk; | |
| 115 | − void __iomem *base; | |
| 116 | − unsigned int irq; | |
| 117 | − u8 location; | |
| 118 | − unsigned long frequency; | |
| 119 | − | |
| 120 | − /* transfer data */ | |
| 121 | − struct completion done; | |
| 122 | − struct i2c_msg *msgs; | |
| 123 | − size_t num_msgs; | |
| 124 | − size_t current_word, current_msg; | |
| 125 | − int retval; | |
| 126 | −}; | |
| 127 | − | |
| 128 | −static u32 efm32_i2c_read32(struct efm32_i2c_ddata *ddata, unsigned offset) | |
| 129 | −{ | |
| 130 | − return readl(ddata->base + offset); | |
| 131 | −} | |
| 132 | − | |
| 133 | −static void efm32_i2c_write32(struct efm32_i2c_ddata *ddata, | |
| 134 | − unsigned offset, u32 value) | |
| 135 | −{ | |
| 136 | − writel(value, ddata->base + offset); | |
| 137 | −} | |
| 138 | − | |
| 139 | −static void efm32_i2c_send_next_msg(struct efm32_i2c_ddata *ddata) | |
| 140 | −{ | |
| 141 | − struct i2c_msg *cur_msg = &ddata->msgs[ddata->current_msg]; | |
| 142 | − | |
| 143 | − efm32_i2c_write32(ddata, REG_CMD, REG_CMD_START); | |
| 144 | − efm32_i2c_write32(ddata, REG_TXDATA, i2c_8bit_addr_from_msg(cur_msg)); | |
| 145 | −} | |
| 146 | − | |
| 147 | −static void efm32_i2c_send_next_byte(struct efm32_i2c_ddata *ddata) | |
| 148 | −{ | |
| 149 | − struct i2c_msg *cur_msg = &ddata->msgs[ddata->current_msg]; | |
| 150 | − | |
| 151 | − if (ddata->current_word >= cur_msg->len) { | |
| 152 | − /* cur_msg completely transferred */ | |
| 153 | − ddata->current_word = 0; | |
| 154 | − ddata->current_msg += 1; | |
| 155 | − | |
| 156 | − if (ddata->current_msg >= ddata->num_msgs) { | |
| 157 | − efm32_i2c_write32(ddata, REG_CMD, REG_CMD_STOP); | |
| 158 | − complete(&ddata->done); | |
| 159 | − } else { | |
| 160 | − efm32_i2c_send_next_msg(ddata); | |
| 161 | − } | |
| 162 | − } else { | |
| 163 | − efm32_i2c_write32(ddata, REG_TXDATA, | |
| 164 | − cur_msg->buf[ddata->current_word++]); | |
| 165 | − } | |
| 166 | −} | |
| 167 | − | |
| 168 | −static void efm32_i2c_recv_next_byte(struct efm32_i2c_ddata *ddata) | |
| 169 | −{ | |
| 170 | − struct i2c_msg *cur_msg = &ddata->msgs[ddata->current_msg]; | |
| 171 | − | |
| 172 | − cur_msg->buf[ddata->current_word] = efm32_i2c_read32(ddata, REG_RXDATA); | |
| 173 | − ddata->current_word += 1; | |
| 174 | − if (ddata->current_word >= cur_msg->len) { | |
| 175 | − /* cur_msg completely transferred */ | |
| 176 | − ddata->current_word = 0; | |
| 177 | − ddata->current_msg += 1; | |
| 178 | − | |
| 179 | − efm32_i2c_write32(ddata, REG_CMD, REG_CMD_NACK); | |
| 180 | − | |
| 181 | − if (ddata->current_msg >= ddata->num_msgs) { | |
| 182 | − efm32_i2c_write32(ddata, REG_CMD, REG_CMD_STOP); | |
| 183 | − complete(&ddata->done); | |
| 184 | − } else { | |
| 185 | − efm32_i2c_send_next_msg(ddata); | |
| 186 | − } | |
| 187 | − } else { | |
| 188 | − efm32_i2c_write32(ddata, REG_CMD, REG_CMD_ACK); | |
| 189 | − } | |
| 190 | −} | |
| 191 | − | |
| 192 | −static irqreturn_t efm32_i2c_irq(int irq, void *dev_id) | |
| 193 | −{ | |
| 194 | − struct efm32_i2c_ddata *ddata = dev_id; | |
| 195 | − struct i2c_msg *cur_msg = &ddata->msgs[ddata->current_msg]; | |
| 196 | − u32 irqflag = efm32_i2c_read32(ddata, REG_IF); | |
| 197 | − u32 state = efm32_i2c_read32(ddata, REG_STATE); | |
| 198 | − | |
| 199 | − efm32_i2c_write32(ddata, REG_IFC, irqflag & REG_IFC__MASK); | |
| 200 | − | |
| 201 | − switch (state & REG_STATE_STATE__MASK) { | |
| 202 | − case REG_STATE_STATE_IDLE: | |
| 203 | − /* arbitration lost? */ | |
| 204 | − ddata->retval = -EAGAIN; | |
| 205 | − complete(&ddata->done); | |
| 206 | − break; | |
| 207 | − case REG_STATE_STATE_WAIT: | |
| 208 | − /* | |
| 209 | − * huh, this shouldn't happen. | |
| 210 | − * Reset hardware state and get out | |
| 211 | − */ | |
| 212 | − ddata->retval = -EIO; | |
| 213 | − efm32_i2c_write32(ddata, REG_CMD, | |
| 214 | − REG_CMD_STOP | REG_CMD_ABORT | | |
| 215 | − REG_CMD_CLEARTX | REG_CMD_CLEARPC); | |
| 216 | − complete(&ddata->done); | |
| 217 | − break; | |
| 218 | − case REG_STATE_STATE_START: | |
| 219 | − /* "caller" is expected to send an address */ | |
| 220 | − break; | |
| 221 | − case REG_STATE_STATE_ADDR: | |
| 222 | − /* wait for Ack or NAck of slave */ | |
| 223 | − break; | |
| 224 | − case REG_STATE_STATE_ADDRACK: | |
| 225 | − if (state & REG_STATE_NACKED) { | |
| 226 | − efm32_i2c_write32(ddata, REG_CMD, REG_CMD_STOP); | |
| 227 | − ddata->retval = -ENXIO; | |
| 228 | − complete(&ddata->done); | |
| 229 | − } else if (cur_msg->flags & I2C_M_RD) { | |
| 230 | − /* wait for slave to send first data byte */ | |
| 231 | − } else { | |
| 232 | − efm32_i2c_send_next_byte(ddata); | |
| 233 | − } | |
| 234 | − break; | |
| 235 | − case REG_STATE_STATE_DATA: | |
| 236 | − if (cur_msg->flags & I2C_M_RD) { | |
| 237 | − efm32_i2c_recv_next_byte(ddata); | |
| 238 | − } else { | |
| 239 | − /* wait for Ack or Nack of slave */ | |
| 240 | − } | |
| 241 | − break; | |
| 242 | − case REG_STATE_STATE_DATAACK: | |
| 243 | − if (state & REG_STATE_NACKED) { | |
| 244 | − efm32_i2c_write32(ddata, REG_CMD, REG_CMD_STOP); | |
| 245 | − complete(&ddata->done); | |
| 246 | − } else { | |
| 247 | − efm32_i2c_send_next_byte(ddata); | |
| 248 | − } | |
| 249 | − } | |
| 250 | − | |
| 251 | − return IRQ_HANDLED; | |
| 252 | −} | |
| 253 | − | |
| 254 | −static int efm32_i2c_master_xfer(struct i2c_adapter *adap, | |
| 255 | − struct i2c_msg *msgs, int num) | |
| 256 | −{ | |
| 257 | − struct efm32_i2c_ddata *ddata = i2c_get_adapdata(adap); | |
| 258 | − int ret; | |
| 259 | − | |
| 260 | − if (ddata->msgs) | |
| 261 | − return -EBUSY; | |
| 262 | − | |
| 263 | − ddata->msgs = msgs; | |
| 264 | − ddata->num_msgs = num; | |
| 265 | − ddata->current_word = 0; | |
| 266 | − ddata->current_msg = 0; | |
| 267 | − ddata->retval = -EIO; | |
| 268 | − | |
| 269 | − reinit_completion(&ddata->done); | |
| 270 | − | |
| 271 | − dev_dbg(&ddata->adapter.dev, "state: %08x, status: %08x\n", | |
| 272 | − efm32_i2c_read32(ddata, REG_STATE), | |
| 273 | − efm32_i2c_read32(ddata, REG_STATUS)); | |
| 274 | − | |
| 275 | − efm32_i2c_send_next_msg(ddata); | |
| 276 | − | |
| 277 | − wait_for_completion(&ddata->done); | |
| 278 | − | |
| 279 | − if (ddata->current_msg >= ddata->num_msgs) | |
| 280 | − ret = ddata->num_msgs; | |
| 281 | − else | |
| 282 | − ret = ddata->retval; | |
| 283 | − | |
| 284 | − return ret; | |
| 285 | −} | |
| 286 | − | |
| 287 | −static u32 efm32_i2c_functionality(struct i2c_adapter *adap) | |
| 288 | −{ | |
| 289 | − return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL; | |
| 290 | −} | |
| 291 | − | |
| 292 | −static const struct i2c_algorithm efm32_i2c_algo = { | |
| 293 | − .master_xfer = efm32_i2c_master_xfer, | |
| 294 | − .functionality = efm32_i2c_functionality, | |
| 295 | −}; | |
| 296 | − | |
| 297 | −static u32 efm32_i2c_get_configured_location(struct efm32_i2c_ddata *ddata) | |
| 298 | −{ | |
| 299 | − u32 reg = efm32_i2c_read32(ddata, REG_ROUTE); | |
| 300 | − | |
| 301 | − return (reg & REG_ROUTE_LOCATION__MASK) >> | |
| 302 | − __ffs(REG_ROUTE_LOCATION__MASK); | |
| 303 | −} | |
| 304 | − | |
| 305 | −static int efm32_i2c_probe(struct platform_device *pdev) | |
| 306 | −{ | |
| 307 | − struct efm32_i2c_ddata *ddata; | |
| 308 | − struct resource *res; | |
| 309 | − unsigned long rate; | |
| 310 | − struct device_node *np = pdev->dev.of_node; | |
| 311 | − u32 location, frequency; | |
| 312 | − int ret; | |
| 313 | − u32 clkdiv; | |
| 314 | − | |
| 315 | − ddata = devm_kzalloc(&pdev->dev, sizeof(*ddata), GFP_KERNEL); | |
| 316 | − if (!ddata) | |
| 317 | − return -ENOMEM; | |
| 318 | − platform_set_drvdata(pdev, ddata); | |
| 319 | − | |
| 320 | − init_completion(&ddata->done); | |
| 321 | − strlcpy(ddata->adapter.name, pdev->name, sizeof(ddata->adapter.name)); | |
| 322 | − ddata->adapter.owner = THIS_MODULE; | |
| 323 | − ddata->adapter.algo = &efm32_i2c_algo; | |
| 324 | − ddata->adapter.dev.parent = &pdev->dev; | |
| 325 | − ddata->adapter.dev.of_node = pdev->dev.of_node; | |
| 326 | − i2c_set_adapdata(&ddata->adapter, ddata); | |
| 327 | − | |
| 328 | − ddata->clk = devm_clk_get(&pdev->dev, NULL); | |
| 329 | − if (IS_ERR(ddata->clk)) { | |
| 330 | − ret = PTR_ERR(ddata->clk); | |
| 331 | − dev_err(&pdev->dev, "failed to get clock: %d\n", ret); | |
| 332 | − return ret; | |
| 333 | − } | |
| 334 | − | |
| 335 | − ddata->base = devm_platform_get_and_ioremap_resource(pdev, 0, &res); | |
| 336 | − if (IS_ERR(ddata->base)) | |
| 337 | − return PTR_ERR(ddata->base); | |
| 338 | − | |
| 339 | − if (resource_size(res) < 0x42) { | |
| 340 | − dev_err(&pdev->dev, "memory resource too small\n"); | |
| 341 | − return -EINVAL; | |
| 342 | − } | |
| 343 | − | |
| 344 | − ret = platform_get_irq(pdev, 0); | |
| 345 | − if (ret <= 0) { | |
| 346 | − if (!ret) | |
| 347 | − ret = -EINVAL; | |
| 348 | − return ret; | |
| 349 | − } | |
| 350 | − | |
| 351 | − ddata->irq = ret; | |
| 352 | − | |
| 353 | − ret = clk_prepare_enable(ddata->clk); | |
| 354 | − if (ret < 0) { | |
| 355 | − dev_err(&pdev->dev, "failed to enable clock (%d)\n", ret); | |
| 356 | − return ret; | |
| 357 | − } | |
| 358 | − | |
| 359 | − | |
| 360 | − ret = of_property_read_u32(np, "energymicro,location", &location); | |
| 361 | − | |
| 362 | − if (ret) | |
| 363 | − /* fall back to wrongly namespaced property */ | |
| 364 | − ret = of_property_read_u32(np, "efm32,location", &location); | |
| 365 | − | |
| 366 | − if (!ret) { | |
| 367 | − dev_dbg(&pdev->dev, "using location %u\n", location); | |
| 368 | − } else { | |
| 369 | − /* default to location configured in hardware */ | |
| 370 | − location = efm32_i2c_get_configured_location(ddata); | |
| 371 | − | |
| 372 | − dev_info(&pdev->dev, "fall back to location %u\n", location); | |
| 373 | − } | |
| 374 | − | |
| 375 | − ddata->location = location; | |
| 376 | − | |
| 377 | − ret = of_property_read_u32(np, "clock-frequency", &frequency); | |
| 378 | − if (!ret) { | |
| 379 | − dev_dbg(&pdev->dev, "using frequency %u\n", frequency); | |
| 380 | − } else { | |
| 381 | − frequency = I2C_MAX_STANDARD_MODE_FREQ; | |
| 382 | − dev_info(&pdev->dev, "defaulting to 100 kHz\n"); | |
| 383 | − } | |
| 384 | − ddata->frequency = frequency; | |
| 385 | − | |
| 386 | − rate = clk_get_rate(ddata->clk); | |
| 387 | − if (!rate) { | |
| 388 | − dev_err(&pdev->dev, "there is no input clock available\n"); | |
| 389 | − ret = -EINVAL; | |
| 390 | − goto err_disable_clk; | |
| 391 | − } | |
| 392 | − clkdiv = DIV_ROUND_UP(rate, 8 * ddata->frequency) - 1; | |
| 393 | − if (clkdiv >= 0x200) { | |
| 394 | − dev_err(&pdev->dev, | |
| 395 | − "input clock too fast (%lu) to divide down to bus freq (%lu)", | |
| 396 | − rate, ddata->frequency); | |
| 397 | − ret = -EINVAL; | |
| 398 | − goto err_disable_clk; | |
| 399 | − } | |
| 400 | − | |
| 401 | − dev_dbg(&pdev->dev, "input clock = %lu, bus freq = %lu, clkdiv = %lu\n", | |
| 402 | − rate, ddata->frequency, (unsigned long)clkdiv); | |
| 403 | − efm32_i2c_write32(ddata, REG_CLKDIV, REG_CLKDIV_DIV(clkdiv)); | |
| 404 | − | |
| 405 | − efm32_i2c_write32(ddata, REG_ROUTE, REG_ROUTE_SDAPEN | | |
| 406 | − REG_ROUTE_SCLPEN | | |
| 407 | − REG_ROUTE_LOCATION(ddata->location)); | |
| 408 | − | |
| 409 | − efm32_i2c_write32(ddata, REG_CTRL, REG_CTRL_EN | | |
| 410 | − REG_CTRL_BITO_160PCC | 0 * REG_CTRL_GIBITO); | |
| 411 | − | |
| 412 | − efm32_i2c_write32(ddata, REG_IFC, REG_IFC__MASK); | |
| 413 | − efm32_i2c_write32(ddata, REG_IEN, REG_IF_TXC | REG_IF_ACK | REG_IF_NACK | |
| 414 | − | REG_IF_ARBLOST | REG_IF_BUSERR | REG_IF_RXDATAV); | |
| 415 | − | |
| 416 | − /* to make bus idle */ | |
| 417 | − efm32_i2c_write32(ddata, REG_CMD, REG_CMD_ABORT); | |
| 418 | − | |
| 419 | − ret = request_irq(ddata->irq, efm32_i2c_irq, 0, DRIVER_NAME, ddata); | |
| 420 | − if (ret < 0) { | |
| 421 | − dev_err(&pdev->dev, "failed to request irq (%d)\n", ret); | |
| 422 | − goto err_disable_clk; | |
| 423 | − } | |
| 424 | − | |
| 425 | − ret = i2c_add_adapter(&ddata->adapter); | |
| 426 | − if (ret) { | |
| 427 | − free_irq(ddata->irq, ddata); | |
| 428 | − | |
| 429 | −err_disable_clk: | |
| 430 | − clk_disable_unprepare(ddata->clk); | |
| 431 | − } | |
| 432 | − return ret; | |
| 433 | −} | |
| 434 | − | |
| 435 | −static int efm32_i2c_remove(struct platform_device *pdev) | |
| 436 | −{ | |
| 437 | − struct efm32_i2c_ddata *ddata = platform_get_drvdata(pdev); | |
| 438 | − | |
| 439 | − i2c_del_adapter(&ddata->adapter); | |
| 440 | − free_irq(ddata->irq, ddata); | |
| 441 | − clk_disable_unprepare(ddata->clk); | |
| 442 | − | |
| 443 | − return 0; | |
| 444 | −} | |
| 445 | − | |
| 446 | −static const struct of_device_id efm32_i2c_dt_ids[] = { | |
| 447 | − { | |
| 448 | − .compatible = "energymicro,efm32-i2c", | |
| 449 | − }, { | |
| 450 | − /* sentinel */ | |
| 451 | − } | |
| 452 | −}; | |
| 453 | −MODULE_DEVICE_TABLE(of, efm32_i2c_dt_ids); | |
| 454 | − | |
| 455 | −static struct platform_driver efm32_i2c_driver = { | |
| 456 | − .probe = efm32_i2c_probe, | |
| 457 | − .remove = efm32_i2c_remove, | |
| 458 | − | |
| 459 | − .driver = { | |
| 460 | − .name = DRIVER_NAME, | |
| 461 | − .of_match_table = efm32_i2c_dt_ids, | |
| 462 | − }, | |
| 463 | −}; | |
| 464 | −module_platform_driver(efm32_i2c_driver); | |
| 465 | − | |
| 466 | −MODULE_AUTHOR("Uwe Kleine-Koenig <u.kleine-koenig@pengutronix.de>"); | |
| 467 | −MODULE_DESCRIPTION("EFM32 i2c driver"); | |
| 468 | −MODULE_LICENSE("GPL v2"); | |
| 469 | −MODULE_ALIAS("platform:" DRIVER_NAME); | |
| @@ -49,7 +49,7 @@ static int mmapped; · 48 unmodified lines | ||
| 49 | 49 | |
| 50 | 50 | static wait_queue_head_t pcf_wait; |
| 51 | 51 | static int pcf_pending; |
| 52 | −static spinlock_t lock; | |
| 52 | +static DEFINE_SPINLOCK(lock); | |
| 53 | 53 | |
| 54 | 54 | static struct i2c_adapter pcf_isa_ops; |
| 55 | 55 | |
| @@ -132,7 +132,6 @@ static irqreturn_t pcf_isa_handler(int this_irq, void *dev_id) { · 76 unmodified lines | ||
| 132 | 132 | |
| 133 | 133 | static int pcf_isa_init(void) |
| 134 | 134 | { |
| 135 | − spin_lock_init(&lock); | |
| 136 | 135 | if (!mmapped) { |
| 137 | 136 | if (!request_region(base, 2, pcf_isa_ops.name)) { |
| 138 | 137 | printk(KERN_ERR "%s: requested I/O region (%#x:2) is " |
| @@ -520,5 +520,5 @@ module_exit(i2c_gpio_exit); · 519 unmodified lines | ||
| 520 | 520 | |
| 521 | 521 | MODULE_AUTHOR("Haavard Skinnemoen (Atmel)"); |
| 522 | 522 | MODULE_DESCRIPTION("Platform-independent bitbanging I2C driver"); |
| 523 | −MODULE_LICENSE("GPL"); | |
| 523 | +MODULE_LICENSE("GPL v2"); | |
| 524 | 524 | MODULE_ALIAS("platform:i2c-gpio"); |
| @@ -413,10 +413,8 @@ static int hix5hd2_i2c_probe(struct platform_device *pdev) · 412 unmodified lines | ||
| 413 | 413 | return PTR_ERR(priv->regs); |
| 414 | 414 | |
| 415 | 415 | irq = platform_get_irq(pdev, 0); |
| 416 | − if (irq <= 0) { | |
| 417 | − dev_err(&pdev->dev, "cannot find HS-I2C IRQ\n"); | |
| 416 | + if (irq <= 0) | |
| 418 | 417 | return irq; |
| 419 | − } | |
| 420 | 418 | |
| 421 | 419 | priv->clk = devm_clk_get(&pdev->dev, NULL); |
| 422 | 420 | if (IS_ERR(priv->clk)) { |
| @@ -72,6 +72,7 @@ · 71 unmodified lines | ||
| 72 | 72 | * Jasper Lake (SOC) 0x4da3 32 hard yes yes yes |
| 73 | 73 | * Comet Lake-V (PCH) 0xa3a3 32 hard yes yes yes |
| 74 | 74 | * Alder Lake-S (PCH) 0x7aa3 32 hard yes yes yes |
| 75 | + * Alder Lake-P (PCH) 0x51a3 32 hard yes yes yes | |
| 75 | 76 | * |
| 76 | 77 | * Features supported by this driver: |
| 77 | 78 | * Software PEC no |
| @@ -228,6 +229,7 @@ · 150 unmodified lines | ||
| 228 | 229 | #define PCI_DEVICE_ID_INTEL_TIGERLAKE_H_SMBUS 0x43a3 |
| 229 | 230 | #define PCI_DEVICE_ID_INTEL_ELKHART_LAKE_SMBUS 0x4b23 |
| 230 | 231 | #define PCI_DEVICE_ID_INTEL_JASPER_LAKE_SMBUS 0x4da3 |
| 232 | +#define PCI_DEVICE_ID_INTEL_ALDER_LAKE_P_SMBUS 0x51a3 | |
| 231 | 233 | #define PCI_DEVICE_ID_INTEL_BROXTON_SMBUS 0x5ad4 |
| 232 | 234 | #define PCI_DEVICE_ID_INTEL_ALDER_LAKE_S_SMBUS 0x7aa3 |
| 233 | 235 | #define PCI_DEVICE_ID_INTEL_LYNXPOINT_SMBUS 0x8c22 |
| @@ -1084,6 +1086,7 @@ static const struct pci_device_id i801_ids[] = { · 850 unmodified lines | ||
| 1084 | 1086 | { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_TIGERLAKE_H_SMBUS) }, |
| 1085 | 1087 | { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_JASPER_LAKE_SMBUS) }, |
| 1086 | 1088 | { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ALDER_LAKE_S_SMBUS) }, |
| 1089 | + { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ALDER_LAKE_P_SMBUS) }, | |
| 1087 | 1090 | { 0, } |
| 1088 | 1091 | }; |
| 1089 | 1092 | |
| @@ -1433,7 +1436,7 @@ static int i801_add_mux(struct i801_priv *priv) · 343 unmodified lines | ||
| 1433 | 1436 | const struct i801_mux_config *mux_config; |
| 1434 | 1437 | struct i2c_mux_gpio_platform_data gpio_data; |
| 1435 | 1438 | struct gpiod_lookup_table *lookup; |
| 1436 | − int err, i; | |
| 1439 | + int i; | |
| 1437 | 1440 | |
| 1438 | 1441 | if (!priv->mux_drvdata) |
| 1439 | 1442 | return 0; |
| @@ -1473,22 +1476,17 @@ static int i801_add_mux(struct i801_priv *priv) · 33 unmodified lines | ||
| 1473 | 1476 | PLATFORM_DEVID_NONE, &gpio_data, |
| 1474 | 1477 | sizeof(struct i2c_mux_gpio_platform_data)); |
| 1475 | 1478 | if (IS_ERR(priv->mux_pdev)) { |
| 1476 | − err = PTR_ERR(priv->mux_pdev); | |
| 1477 | 1479 | gpiod_remove_lookup_table(lookup); |
| 1478 | − priv->mux_pdev = NULL; | |
| 1479 | 1480 | dev_err(dev, "Failed to register i2c-mux-gpio device\n"); |
| 1480 | − return err; | |
| 1481 | 1481 | } |
| 1482 | 1482 | |
| 1483 | − return 0; | |
| 1483 | + return PTR_ERR_OR_ZERO(priv->mux_pdev); | |
| 1484 | 1484 | } |
| 1485 | 1485 | |
| 1486 | 1486 | static void i801_del_mux(struct i801_priv *priv) |
| 1487 | 1487 | { |
| 1488 | − if (priv->mux_pdev) | |
| 1489 | − platform_device_unregister(priv->mux_pdev); | |
| 1490 | − if (priv->lookup) | |
| 1491 | − gpiod_remove_lookup_table(priv->lookup); | |
| 1488 | + platform_device_unregister(priv->mux_pdev); | |
| 1489 | + gpiod_remove_lookup_table(priv->lookup); | |
| 1492 | 1490 | } |
| 1493 | 1491 | |
| 1494 | 1492 | static unsigned int i801_get_adapter_class(struct i801_priv *priv) |
| @@ -1772,6 +1770,7 @@ static int i801_probe(struct pci_dev *dev, const struct pci_device_id *id) · 277 unmodified lines | ||
| 1772 | 1770 | case PCI_DEVICE_ID_INTEL_JASPER_LAKE_SMBUS: |
| 1773 | 1771 | case PCI_DEVICE_ID_INTEL_EBG_SMBUS: |
| 1774 | 1772 | case PCI_DEVICE_ID_INTEL_ALDER_LAKE_S_SMBUS: |
| 1773 | + case PCI_DEVICE_ID_INTEL_ALDER_LAKE_P_SMBUS: | |
| 1775 | 1774 | priv->features |= FEATURE_BLOCK_PROC; |
| 1776 | 1775 | priv->features |= FEATURE_I2C_BLOCK_READ; |
| 1777 | 1776 | priv->features |= FEATURE_IRQ; |
| @@ -209,6 +209,7 @@ struct imx_i2c_struct { · 208 unmodified lines | ||
| 209 | 209 | |
| 210 | 210 | struct imx_i2c_dma *dma; |
| 211 | 211 | struct i2c_client *slave; |
| 212 | + enum i2c_slave_event last_slave_event; | |
| 212 | 213 | }; |
| 213 | 214 | |
| 214 | 215 | static const struct imx_i2c_hwdata imx1_i2c_hwdata = { |
| @@ -550,7 +551,7 @@ static void i2c_imx_set_clk(struct imx_i2c_struct *i2c_imx, · 335 unmodified lines | ||
| 550 | 551 | |
| 551 | 552 | i2c_imx->cur_clk = i2c_clk_rate; |
| 552 | 553 | |
| 553 | − div = (i2c_clk_rate + i2c_imx->bitrate - 1) / i2c_imx->bitrate; | |
| 554 | + div = DIV_ROUND_UP(i2c_clk_rate, i2c_imx->bitrate); | |
| 554 | 555 | if (div < i2c_clk_div[0].div) |
| 555 | 556 | i = 0; |
| 556 | 557 | else if (div > i2c_clk_div[i2c_imx->hwdata->ndivs - 1].div) |
| @@ -568,8 +569,8 @@ static void i2c_imx_set_clk(struct imx_i2c_struct *i2c_imx, · 11 unmodified lines | ||
| 568 | 569 | * This delay is used in I2C bus disable function |
| 569 | 570 | * to fix chip hardware bug. |
| 570 | 571 | */ |
| 571 | − i2c_imx->disable_delay = (500000U * i2c_clk_div[i].div | |
| 572 | − + (i2c_clk_rate / 2) - 1) / (i2c_clk_rate / 2); | |
| 572 | + i2c_imx->disable_delay = DIV_ROUND_UP(500000U * i2c_clk_div[i].div, | |
| 573 | + i2c_clk_rate / 2); | |
| 573 | 574 | |
| 574 | 575 | #ifdef CONFIG_I2C_DEBUG_BUS |
| 575 | 576 | dev_dbg(&i2c_imx->adapter.dev, "I2C_CLK=%d, REQ DIV=%d\n", |
| @@ -675,6 +676,36 @@ static void i2c_imx_enable_bus_idle(struct imx_i2c_struct *i2c_imx) · 99 unmodified lines | ||
| 675 | 676 | } |
| 676 | 677 | } |
| 677 | 678 | |
| 679 | +static void i2c_imx_slave_event(struct imx_i2c_struct *i2c_imx, | |
| 680 | + enum i2c_slave_event event, u8 *val) | |
| 681 | +{ | |
| 682 | + i2c_slave_event(i2c_imx->slave, event, val); | |
| 683 | + i2c_imx->last_slave_event = event; | |
| 684 | +} | |
| 685 | + | |
| 686 | +static void i2c_imx_slave_finish_op(struct imx_i2c_struct *i2c_imx) | |
| 687 | +{ | |
| 688 | + u8 val; | |
| 689 | + | |
| 690 | + while (i2c_imx->last_slave_event != I2C_SLAVE_STOP) { | |
| 691 | + switch (i2c_imx->last_slave_event) { | |
| 692 | + case I2C_SLAVE_READ_REQUESTED: | |
| 693 | + i2c_imx_slave_event(i2c_imx, I2C_SLAVE_READ_PROCESSED, | |
| 694 | + &val); | |
| 695 | + break; | |
| 696 | + | |
| 697 | + case I2C_SLAVE_WRITE_REQUESTED: | |
| 698 | + case I2C_SLAVE_READ_PROCESSED: | |
| 699 | + case I2C_SLAVE_WRITE_RECEIVED: | |
| 700 | + i2c_imx_slave_event(i2c_imx, I2C_SLAVE_STOP, &val); | |
| 701 | + break; | |
| 702 | + | |
| 703 | + case I2C_SLAVE_STOP: | |
| 704 | + break; | |
| 705 | + } | |
| 706 | + } | |
| 707 | +} | |
| 708 | + | |
| 678 | 709 | static irqreturn_t i2c_imx_slave_isr(struct imx_i2c_struct *i2c_imx, |
| 679 | 710 | unsigned int status, unsigned int ctl) |
| 680 | 711 | { |
| @@ -687,9 +718,11 @@ static irqreturn_t i2c_imx_slave_isr(struct imx_i2c_struct *i2c_imx, · 6 unmodified lines | ||
| 687 | 718 | } |
| 688 | 719 | |
| 689 | 720 | if (status & I2SR_IAAS) { /* Addressed as a slave */ |
| 721 | + i2c_imx_slave_finish_op(i2c_imx); | |
| 690 | 722 | if (status & I2SR_SRW) { /* Master wants to read from us*/ |
| 691 | 723 | dev_dbg(&i2c_imx->adapter.dev, "read requested"); |
| 692 | − i2c_slave_event(i2c_imx->slave, I2C_SLAVE_READ_REQUESTED, &value); | |
| 724 | + i2c_imx_slave_event(i2c_imx, | |
| 725 | + I2C_SLAVE_READ_REQUESTED, &value); | |
| 693 | 726 | |
| 694 | 727 | /* Slave transmit */ |
| 695 | 728 | ctl |= I2CR_MTX; |
| @@ -699,7 +732,8 @@ static irqreturn_t i2c_imx_slave_isr(struct imx_i2c_struct *i2c_imx, · 3 unmodified lines | ||
| 699 | 732 | imx_i2c_write_reg(value, i2c_imx, IMX_I2C_I2DR); |
| 700 | 733 | } else { /* Master wants to write to us */ |
| 701 | 734 | dev_dbg(&i2c_imx->adapter.dev, "write requested"); |
| 702 | − i2c_slave_event(i2c_imx->slave, I2C_SLAVE_WRITE_REQUESTED, &value); | |
| 735 | + i2c_imx_slave_event(i2c_imx, | |
| 736 | + I2C_SLAVE_WRITE_REQUESTED, &value); | |
| 703 | 737 | |
| 704 | 738 | /* Slave receive */ |
| 705 | 739 | ctl &= ~I2CR_MTX; |
| @@ -710,17 +744,20 @@ static irqreturn_t i2c_imx_slave_isr(struct imx_i2c_struct *i2c_imx, · 4 unmodified lines | ||
| 710 | 744 | } else if (!(ctl & I2CR_MTX)) { /* Receive mode */ |
| 711 | 745 | if (status & I2SR_IBB) { /* No STOP signal detected */ |
| 712 | 746 | value = imx_i2c_read_reg(i2c_imx, IMX_I2C_I2DR); |
| 713 | − i2c_slave_event(i2c_imx->slave, I2C_SLAVE_WRITE_RECEIVED, &value); | |
| 747 | + i2c_imx_slave_event(i2c_imx, | |
| 748 | + I2C_SLAVE_WRITE_RECEIVED, &value); | |
| 714 | 749 | } else { /* STOP signal is detected */ |
| 715 | 750 | dev_dbg(&i2c_imx->adapter.dev, |
| 716 | 751 | "STOP signal detected"); |
| 717 | − i2c_slave_event(i2c_imx->slave, I2C_SLAVE_STOP, &value); | |
| 752 | + i2c_imx_slave_event(i2c_imx, | |
| 753 | + I2C_SLAVE_STOP, &value); | |
| 718 | 754 | } |
| 719 | 755 | } else if (!(status & I2SR_RXAK)) { /* Transmit mode received ACK */ |
| 720 | 756 | ctl |= I2CR_MTX; |
| 721 | 757 | imx_i2c_write_reg(ctl, i2c_imx, IMX_I2C_I2CR); |
| 722 | 758 | |
| 723 | − i2c_slave_event(i2c_imx->slave, I2C_SLAVE_READ_PROCESSED, &value); | |
| 759 | + i2c_imx_slave_event(i2c_imx, | |
| 760 | + I2C_SLAVE_READ_PROCESSED, &value); | |
| 724 | 761 | |
| 725 | 762 | imx_i2c_write_reg(value, i2c_imx, IMX_I2C_I2DR); |
| 726 | 763 | } else { /* Transmit mode received NAK */ |
| @@ -761,6 +798,7 @@ static int i2c_imx_reg_slave(struct i2c_client *client) · 34 unmodified lines | ||
| 761 | 798 | return -EBUSY; |
| 762 | 799 | |
| 763 | 800 | i2c_imx->slave = client; |
| 801 | + i2c_imx->last_slave_event = I2C_SLAVE_STOP; | |
| 764 | 802 | |
| 765 | 803 | /* Resume */ |
| 766 | 804 | ret = pm_runtime_get_sync(i2c_imx->adapter.dev.parent); |
| @@ -813,10 +851,17 @@ static irqreturn_t i2c_imx_isr(int irq, void *dev_id) · 46 unmodified lines | ||
| 813 | 851 | |
| 814 | 852 | status = imx_i2c_read_reg(i2c_imx, IMX_I2C_I2SR); |
| 815 | 853 | ctl = imx_i2c_read_reg(i2c_imx, IMX_I2C_I2CR); |
| 854 | + | |
| 816 | 855 | if (status & I2SR_IIF) { |
| 817 | 856 | i2c_imx_clear_irq(i2c_imx, I2SR_IIF); |
| 818 | − if (i2c_imx->slave && !(ctl & I2CR_MSTA)) | |
| 819 | − return i2c_imx_slave_isr(i2c_imx, status, ctl); | |
| 857 | + if (i2c_imx->slave) { | |
| 858 | + if (!(ctl & I2CR_MSTA)) { | |
| 859 | + return i2c_imx_slave_isr(i2c_imx, status, ctl); | |
| 860 | + } else if (i2c_imx->last_slave_event != | |
| 861 | + I2C_SLAVE_STOP) { | |
| 862 | + i2c_imx_slave_finish_op(i2c_imx); | |
| 863 | + } | |
| 864 | + } | |
| 820 | 865 | return i2c_imx_master_isr(i2c_imx, status); |
| 821 | 866 | } |
| 822 | 867 | |
| @@ -437,9 +437,8 @@ static irqreturn_t jz4780_i2c_irq(int irqno, void *dev_id) · 436 unmodified lines | ||
| 437 | 437 | unsigned short intst; |
| 438 | 438 | unsigned short intmsk; |
| 439 | 439 | struct jz4780_i2c *i2c = dev_id; |
| 440 | − unsigned long flags; | |
| 441 | 440 | |
| 442 | − spin_lock_irqsave(&i2c->lock, flags); | |
| 441 | + spin_lock(&i2c->lock); | |
| 443 | 442 | intmsk = jz4780_i2c_readw(i2c, JZ4780_I2C_INTM); |
| 444 | 443 | intst = jz4780_i2c_readw(i2c, JZ4780_I2C_INTST); |
| 445 | 444 | |
| @@ -551,7 +550,7 @@ static irqreturn_t jz4780_i2c_irq(int irqno, void *dev_id) · 105 unmodified lines | ||
| 551 | 550 | } |
| 552 | 551 | |
| 553 | 552 | done: |
| 554 | − spin_unlock_irqrestore(&i2c->lock, flags); | |
| 553 | + spin_unlock(&i2c->lock); | |
| 555 | 554 | return IRQ_HANDLED; |
| 556 | 555 | } |
| 557 | 556 | |
| @@ -1,34 +1,8 @@ | ||
| 1 | +// SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0 | |
| 1 | 2 | /* |
| 2 | − * Copyright (c) 2016 Mellanox Technologies. All rights reserved. | |
| 3 | − * Copyright (c) 2016 Michael Shych <michaels@mellanox.com> | |
| 3 | + * Mellanox i2c driver | |
| 4 | 4 | * |
| 5 | − * Redistribution and use in source and binary forms, with or without | |
| 6 | − * modification, are permitted provided that the following conditions are met: | |
| 7 | − * | |
| 8 | − * 1. Redistributions of source code must retain the above copyright | |
| 9 | − * notice, this list of conditions and the following disclaimer. | |
| 10 | − * 2. Redistributions in binary form must reproduce the above copyright | |
| 11 | − * notice, this list of conditions and the following disclaimer in the | |
| 12 | − * documentation and/or other materials provided with the distribution. | |
| 13 | − * 3. Neither the names of the copyright holders nor the names of its | |
| 14 | − * contributors may be used to endorse or promote products derived from | |
| 15 | − * this software without specific prior written permission. | |
| 16 | − * | |
| 17 | − * Alternatively, this software may be distributed under the terms of the | |
| 18 | − * GNU General Public License ("GPL") version 2 as published by the Free | |
| 19 | − * Software Foundation. | |
| 20 | − * | |
| 21 | − * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" | |
| 22 | − * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE | |
| 23 | − * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE | |
| 24 | − * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE | |
| 25 | − * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR | |
| 26 | − * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF | |
| 27 | − * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS | |
| 28 | − * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN | |
| 29 | − * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) | |
| 30 | − * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE | |
| 31 | − * POSSIBILITY OF SUCH DAMAGE. | |
| 5 | + * Copyright (C) 2016-2020 Mellanox Technologies | |
| 32 | 6 | */ |
| 33 | 7 | |
| 34 | 8 | #include <linux/delay.h> |
| @@ -37,7 +11,9 @@ · 2 unmodified lines | ||
| 37 | 11 | #include <linux/io.h> |
| 38 | 12 | #include <linux/kernel.h> |
| 39 | 13 | #include <linux/module.h> |
| 14 | +#include <linux/platform_data/mlxreg.h> | |
| 40 | 15 | #include <linux/platform_device.h> |
| 16 | +#include <linux/regmap.h> | |
| 41 | 17 | |
| 42 | 18 | /* General defines */ |
| 43 | 19 | #define MLXPLAT_CPLD_LPC_I2C_BASE_ADDR 0x2000 |
| @@ -51,7 +27,7 @@ · 7 unmodified lines | ||
| 51 | 27 | #define MLXCPLD_I2C_MAX_ADDR_LEN 4 |
| 52 | 28 | #define MLXCPLD_I2C_RETR_NUM 2 |
| 53 | 29 | #define MLXCPLD_I2C_XFER_TO 500000 /* usec */ |
| 54 | −#define MLXCPLD_I2C_POLL_TIME 2000 /* usec */ | |
| 30 | +#define MLXCPLD_I2C_POLL_TIME 400 /* usec */ | |
| 55 | 31 | |
| 56 | 32 | /* LPC I2C registers */ |
| 57 | 33 | #define MLXCPLD_LPCI2C_CPBLTY_REG 0x0 |
| @@ -72,6 +48,16 @@ · 14 unmodified lines | ||
| 72 | 48 | #define MLXCPLD_LPCI2C_ACK_IND 1 |
| 73 | 49 | #define MLXCPLD_LPCI2C_NACK_IND 2 |
| 74 | 50 | |
| 51 | +#define MLXCPLD_I2C_FREQ_1000KHZ_SET 0x04 | |
| 52 | +#define MLXCPLD_I2C_FREQ_400KHZ_SET 0x0f | |
| 53 | +#define MLXCPLD_I2C_FREQ_100KHZ_SET 0x42 | |
| 54 | + | |
| 55 | +enum mlxcpld_i2c_frequency { | |
| 56 | + MLXCPLD_I2C_FREQ_1000KHZ = 1, | |
| 57 | + MLXCPLD_I2C_FREQ_400KHZ = 2, | |
| 58 | + MLXCPLD_I2C_FREQ_100KHZ = 3, | |
| 59 | +}; | |
| 60 | + | |
| 75 | 61 | struct mlxcpld_i2c_curr_xfer { |
| 76 | 62 | u8 cmd; |
| 77 | 63 | u8 addr_width; |
| @@ -489,8 +475,45 @@ static struct i2c_adapter mlxcpld_i2c_adapter = { · 411 unmodified lines | ||
| 489 | 475 | .nr = MLXCPLD_I2C_BUS_NUM, |
| 490 | 476 | }; |
| 491 | 477 | |
| 478 | +static int | |
| 479 | +mlxcpld_i2c_set_frequency(struct mlxcpld_i2c_priv *priv, | |
| 480 | + struct mlxreg_core_hotplug_platform_data *pdata) | |
| 481 | +{ | |
| 482 | + struct mlxreg_core_item *item = pdata->items; | |
| 483 | + struct mlxreg_core_data *data; | |
| 484 | + u32 regval; | |
| 485 | + u8 freq; | |
| 486 | + int err; | |
| 487 | + | |
| 488 | + if (!item) | |
| 489 | + return 0; | |
| 490 | + | |
| 491 | + /* Read frequency setting. */ | |
| 492 | + data = item->data; | |
| 493 | + err = regmap_read(pdata->regmap, data->reg, ®val); | |
| 494 | + if (err) | |
| 495 | + return err; | |
| 496 | + | |
| 497 | + /* Set frequency only if it is not 100KHz, which is default. */ | |
| 498 | + switch ((data->reg & data->mask) >> data->bit) { | |
| 499 | + case MLXCPLD_I2C_FREQ_1000KHZ: | |
| 500 | + freq = MLXCPLD_I2C_FREQ_1000KHZ_SET; | |
| 501 | + break; | |
| 502 | + case MLXCPLD_I2C_FREQ_400KHZ: | |
| 503 | + freq = MLXCPLD_I2C_FREQ_400KHZ_SET; | |
| 504 | + break; | |
| 505 | + default: | |
| 506 | + return 0; | |
| 507 | + } | |
| 508 | + | |
| 509 | + mlxcpld_i2c_write_comm(priv, MLXCPLD_LPCI2C_HALF_CYC_REG, &freq, 1); | |
| 510 | + | |
| 511 | + return 0; | |
| 512 | +} | |
| 513 | + | |
| 492 | 514 | static int mlxcpld_i2c_probe(struct platform_device *pdev) |
| 493 | 515 | { |
| 516 | + struct mlxreg_core_hotplug_platform_data *pdata; | |
| 494 | 517 | struct mlxcpld_i2c_priv *priv; |
| 495 | 518 | int err; |
| 496 | 519 | u8 val; |
| @@ -505,6 +528,14 @@ static int mlxcpld_i2c_probe(struct platform_device *pdev) · 8 unmodified lines | ||
| 505 | 528 | priv->dev = &pdev->dev; |
| 506 | 529 | priv->base_addr = MLXPLAT_CPLD_LPC_I2C_BASE_ADDR; |
| 507 | 530 | |
| 531 | + /* Set I2C bus frequency if platform data provides this info. */ | |
| 532 | + pdata = dev_get_platdata(&pdev->dev); | |
| 533 | + if (pdata) { | |
| 534 | + err = mlxcpld_i2c_set_frequency(priv, pdata); | |
| 535 | + if (err) | |
| 536 | + goto mlxcpld_i2_probe_failed; | |
| 537 | + } | |
| 538 | + | |
| 508 | 539 | /* Register with i2c layer */ |
| 509 | 540 | mlxcpld_i2c_adapter.timeout = usecs_to_jiffies(MLXCPLD_I2C_XFER_TO); |
| 510 | 541 | /* Read capability register */ |
| @@ -523,8 +554,12 @@ static int mlxcpld_i2c_probe(struct platform_device *pdev) · 12 unmodified lines | ||
| 523 | 554 | |
| 524 | 555 | err = i2c_add_numbered_adapter(&priv->adap); |
| 525 | 556 | if (err) |
| 526 | − mutex_destroy(&priv->lock); | |
| 557 | + goto mlxcpld_i2_probe_failed; | |
| 527 | 558 | |
| 559 | + return 0; | |
| 560 | + | |
| 561 | +mlxcpld_i2_probe_failed: | |
| 562 | + mutex_destroy(&priv->lock); | |
| 528 | 563 | return err; |
| 529 | 564 | } |
| 530 | 565 | |
| @@ -18,6 +18,7 @@ · 17 unmodified lines | ||
| 18 | 18 | #include <linux/mv643xx_i2c.h> |
| 19 | 19 | #include <linux/platform_device.h> |
| 20 | 20 | #include <linux/pinctrl/consumer.h> |
| 21 | +#include <linux/pm_runtime.h> | |
| 21 | 22 | #include <linux/reset.h> |
| 22 | 23 | #include <linux/io.h> |
| 23 | 24 | #include <linux/of.h> |
| @@ -717,6 +718,10 @@ mv64xxx_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg msgs[], int num) · 693 unmodified lines | ||
| 717 | 718 | struct mv64xxx_i2c_data *drv_data = i2c_get_adapdata(adap); |
| 718 | 719 | int rc, ret = num; |
| 719 | 720 | |
| 721 | + rc = pm_runtime_resume_and_get(&adap->dev); | |
| 722 | + if (rc) | |
| 723 | + return rc; | |
| 724 | + | |
| 720 | 725 | BUG_ON(drv_data->msgs != NULL); |
| 721 | 726 | drv_data->msgs = msgs; |
| 722 | 727 | drv_data->num_msgs = num; |
| @@ -732,6 +737,9 @@ mv64xxx_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg msgs[], int num) · 9 unmodified lines | ||
| 732 | 737 | drv_data->num_msgs = 0; |
| 733 | 738 | drv_data->msgs = NULL; |
| 734 | 739 | |
| 740 | + pm_runtime_mark_last_busy(&adap->dev); | |
| 741 | + pm_runtime_put_autosuspend(&adap->dev); | |
| 742 | + | |
| 735 | 743 | return ret; |
| 736 | 744 | } |
| 737 | 745 | |
| @@ -805,7 +813,7 @@ mv64xxx_of_config(struct mv64xxx_i2c_data *drv_data, · 67 unmodified lines | ||
| 805 | 813 | * need to know tclk in order to calculate bus clock |
| 806 | 814 | * factors. |
| 807 | 815 | */ |
| 808 | − if (IS_ERR(drv_data->clk)) { | |
| 816 | + if (!drv_data->clk) { | |
| 809 | 817 | rc = -ENODEV; |
| 810 | 818 | goto out; |
| 811 | 819 | } |
| @@ -828,7 +836,6 @@ mv64xxx_of_config(struct mv64xxx_i2c_data *drv_data, · 16 unmodified lines | ||
| 828 | 836 | rc = PTR_ERR(drv_data->rstc); |
| 829 | 837 | goto out; |
| 830 | 838 | } |
| 831 | − reset_control_deassert(drv_data->rstc); | |
| 832 | 839 | |
| 833 | 840 | /* Its not yet defined how timeouts will be specified in device tree. |
| 834 | 841 | * So hard code the value to 1 second. |
| @@ -893,6 +900,32 @@ static int mv64xxx_i2c_init_recovery_info(struct mv64xxx_i2c_data *drv_data, · 58 unmodified lines | ||
| 893 | 900 | return 0; |
| 894 | 901 | } |
| 895 | 902 | |
| 903 | +static int | |
| 904 | +mv64xxx_i2c_runtime_suspend(struct device *dev) | |
| 905 | +{ | |
| 906 | + struct mv64xxx_i2c_data *drv_data = dev_get_drvdata(dev); | |
| 907 | + | |
| 908 | + reset_control_assert(drv_data->rstc); | |
| 909 | + clk_disable_unprepare(drv_data->reg_clk); | |
| 910 | + clk_disable_unprepare(drv_data->clk); | |
| 911 | + | |
| 912 | + return 0; | |
| 913 | +} | |
| 914 | + | |
| 915 | +static int | |
| 916 | +mv64xxx_i2c_runtime_resume(struct device *dev) | |
| 917 | +{ | |
| 918 | + struct mv64xxx_i2c_data *drv_data = dev_get_drvdata(dev); | |
| 919 | + | |
| 920 | + clk_prepare_enable(drv_data->clk); | |
| 921 | + clk_prepare_enable(drv_data->reg_clk); | |
| 922 | + reset_control_reset(drv_data->rstc); | |
| 923 | + | |
| 924 | + mv64xxx_i2c_hw_init(drv_data); | |
| 925 | + | |
| 926 | + return 0; | |
| 927 | +} | |
| 928 | + | |
| 896 | 929 | static int |
| 897 | 930 | mv64xxx_i2c_probe(struct platform_device *pd) |
| 898 | 931 | { |
| @@ -920,18 +953,22 @@ mv64xxx_i2c_probe(struct platform_device *pd) · 21 unmodified lines | ||
| 920 | 953 | |
| 921 | 954 | /* Not all platforms have clocks */ |
| 922 | 955 | drv_data->clk = devm_clk_get(&pd->dev, NULL); |
| 923 | − if (PTR_ERR(drv_data->clk) == -EPROBE_DEFER) | |
| 924 | − return -EPROBE_DEFER; | |
| 925 | − if (!IS_ERR(drv_data->clk)) | |
| 926 | − clk_prepare_enable(drv_data->clk); | |
| 956 | + if (IS_ERR(drv_data->clk)) { | |
| 957 | + if (PTR_ERR(drv_data->clk) == -EPROBE_DEFER) | |
| 958 | + return -EPROBE_DEFER; | |
| 959 | + drv_data->clk = NULL; | |
| 960 | + } | |
| 927 | 961 | |
| 928 | 962 | drv_data->reg_clk = devm_clk_get(&pd->dev, "reg"); |
| 929 | − if (PTR_ERR(drv_data->reg_clk) == -EPROBE_DEFER) | |
| 930 | − return -EPROBE_DEFER; | |
| 931 | − if (!IS_ERR(drv_data->reg_clk)) | |
| 932 | − clk_prepare_enable(drv_data->reg_clk); | |
| 963 | + if (IS_ERR(drv_data->reg_clk)) { | |
| 964 | + if (PTR_ERR(drv_data->reg_clk) == -EPROBE_DEFER) | |
| 965 | + return -EPROBE_DEFER; | |
| 966 | + drv_data->reg_clk = NULL; | |
| 967 | + } | |
| 933 | 968 | |
| 934 | 969 | drv_data->irq = platform_get_irq(pd, 0); |
| 970 | + if (drv_data->irq < 0) | |
| 971 | + return drv_data->irq; | |
| 935 | 972 | |
| 936 | 973 | if (pdata) { |
| 937 | 974 | drv_data->freq_m = pdata->freq_m; |
| @@ -942,16 +979,12 @@ mv64xxx_i2c_probe(struct platform_device *pd) · 4 unmodified lines | ||
| 942 | 979 | } else if (pd->dev.of_node) { |
| 943 | 980 | rc = mv64xxx_of_config(drv_data, &pd->dev); |
| 944 | 981 | if (rc) |
| 945 | − goto exit_clk; | |
| 946 | − } | |
| 947 | − if (drv_data->irq < 0) { | |
| 948 | − rc = drv_data->irq; | |
| 949 | − goto exit_reset; | |
| 982 | + return rc; | |
| 950 | 983 | } |
| 951 | 984 | |
| 952 | 985 | rc = mv64xxx_i2c_init_recovery_info(drv_data, &pd->dev); |
| 953 | 986 | if (rc == -EPROBE_DEFER) |
| 954 | − goto exit_reset; | |
| 987 | + return rc; | |
| 955 | 988 | |
| 956 | 989 | drv_data->adapter.dev.parent = &pd->dev; |
| 957 | 990 | drv_data->adapter.algo = &mv64xxx_i2c_algo; |
| @@ -962,7 +995,14 @@ mv64xxx_i2c_probe(struct platform_device *pd) · 4 unmodified lines | ||
| 962 | 995 | platform_set_drvdata(pd, drv_data); |
| 963 | 996 | i2c_set_adapdata(&drv_data->adapter, drv_data); |
| 964 | 997 | |
| 965 | − mv64xxx_i2c_hw_init(drv_data); | |
| 998 | + pm_runtime_set_autosuspend_delay(&pd->dev, MSEC_PER_SEC); | |
| 999 | + pm_runtime_use_autosuspend(&pd->dev); | |
| 1000 | + pm_runtime_enable(&pd->dev); | |
| 1001 | + if (!pm_runtime_enabled(&pd->dev)) { | |
| 1002 | + rc = mv64xxx_i2c_runtime_resume(&pd->dev); | |
| 1003 | + if (rc) | |
| 1004 | + goto exit_disable_pm; | |
| 1005 | + } | |
| 966 | 1006 | |
| 967 | 1007 | rc = request_irq(drv_data->irq, mv64xxx_i2c_intr, 0, |
| 968 | 1008 | MV64XXX_I2C_CTLR_NAME, drv_data); |
| @@ -970,7 +1010,7 @@ mv64xxx_i2c_probe(struct platform_device *pd) · 1 unmodified line | ||
| 970 | 1010 | dev_err(&drv_data->adapter.dev, |
| 971 | 1011 | "mv64xxx: Can't register intr handler irq%d: %d\n", |
| 972 | 1012 | drv_data->irq, rc); |
| 973 | − goto exit_reset; | |
| 1013 | + goto exit_disable_pm; | |
| 974 | 1014 | } else if ((rc = i2c_add_numbered_adapter(&drv_data->adapter)) != 0) { |
| 975 | 1015 | dev_err(&drv_data->adapter.dev, |
| 976 | 1016 | "mv64xxx: Can't add i2c adapter, rc: %d\n", -rc); |
| @@ -981,54 +1021,50 @@ mv64xxx_i2c_probe(struct platform_device *pd) · 4 unmodified lines | ||
| 981 | 1021 | |
| 982 | 1022 | exit_free_irq: |
| 983 | 1023 | free_irq(drv_data->irq, drv_data); |
| 984 | −exit_reset: | |
| 985 | − reset_control_assert(drv_data->rstc); | |
| 986 | −exit_clk: | |
| 987 | − clk_disable_unprepare(drv_data->reg_clk); | |
| 988 | − clk_disable_unprepare(drv_data->clk); | |
| 1024 | +exit_disable_pm: | |
| 1025 | + pm_runtime_disable(&pd->dev); | |
| 1026 | + if (!pm_runtime_status_suspended(&pd->dev)) | |
| 1027 | + mv64xxx_i2c_runtime_suspend(&pd->dev); | |
| 989 | 1028 | |
| 990 | 1029 | return rc; |
| 991 | 1030 | } |
| 992 | 1031 | |
| 993 | 1032 | static int |
| 994 | −mv64xxx_i2c_remove(struct platform_device *dev) | |
| 1033 | +mv64xxx_i2c_remove(struct platform_device *pd) | |
| 995 | 1034 | { |
| 996 | − struct mv64xxx_i2c_data *drv_data = platform_get_drvdata(dev); | |
| 1035 | + struct mv64xxx_i2c_data *drv_data = platform_get_drvdata(pd); | |
| 997 | 1036 | |
| 998 | 1037 | i2c_del_adapter(&drv_data->adapter); |
| 999 | 1038 | free_irq(drv_data->irq, drv_data); |
| 1000 | − reset_control_assert(drv_data->rstc); | |
| 1001 | − clk_disable_unprepare(drv_data->reg_clk); | |
| 1002 | − clk_disable_unprepare(drv_data->clk); | |
| 1039 | + pm_runtime_disable(&pd->dev); | |
| 1040 | + if (!pm_runtime_status_suspended(&pd->dev)) | |
| 1041 | + mv64xxx_i2c_runtime_suspend(&pd->dev); | |
| 1003 | 1042 | |
| 1004 | 1043 | return 0; |
| 1005 | 1044 | } |
| 1006 | 1045 | |
| 1007 | −#ifdef CONFIG_PM | |
| 1008 | −static int mv64xxx_i2c_resume(struct device *dev) | |
| 1046 | +static void | |
| 1047 | +mv64xxx_i2c_shutdown(struct platform_device *pd) | |
| 1009 | 1048 | { |
| 1010 | − struct mv64xxx_i2c_data *drv_data = dev_get_drvdata(dev); | |
| 1011 | − | |
| 1012 | − mv64xxx_i2c_hw_init(drv_data); | |
| 1013 | − | |
| 1014 | − return 0; | |
| 1049 | + pm_runtime_disable(&pd->dev); | |
| 1050 | + if (!pm_runtime_status_suspended(&pd->dev)) | |
| 1051 | + mv64xxx_i2c_runtime_suspend(&pd->dev); | |
| 1015 | 1052 | } |
| 1016 | 1053 | |
| 1017 | −static const struct dev_pm_ops mv64xxx_i2c_pm = { | |
| 1018 | − .resume = mv64xxx_i2c_resume, | |
| 1054 | +static const struct dev_pm_ops mv64xxx_i2c_pm_ops = { | |
| 1055 | + SET_RUNTIME_PM_OPS(mv64xxx_i2c_runtime_suspend, | |
| 1056 | + mv64xxx_i2c_runtime_resume, NULL) | |
| 1057 | + SET_NOIRQ_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend, | |
| 1058 | + pm_runtime_force_resume) | |
| 1019 | 1059 | }; |
| 1020 | 1060 | |
| 1021 | −#define mv64xxx_i2c_pm_ops (&mv64xxx_i2c_pm) | |
| 1022 | −#else | |
| 1023 | −#define mv64xxx_i2c_pm_ops NULL | |
| 1024 | −#endif | |
| 1025 | − | |
| 1026 | 1061 | static struct platform_driver mv64xxx_i2c_driver = { |
| 1027 | 1062 | .probe = mv64xxx_i2c_probe, |
| 1028 | 1063 | .remove = mv64xxx_i2c_remove, |
| 1064 | + .shutdown = mv64xxx_i2c_shutdown, | |
| 1029 | 1065 | .driver = { |
| 1030 | 1066 | .name = MV64XXX_I2C_CTLR_NAME, |
| 1031 | − .pm = mv64xxx_i2c_pm_ops, | |
| 1067 | + .pm = &mv64xxx_i2c_pm_ops, | |
| 1032 | 1068 | .of_match_table = mv64xxx_i2c_of_match_table, |
| 1033 | 1069 | }, |
| 1034 | 1070 | }; |
| @@ -86,6 +86,9 @@ struct geni_i2c_dev { · 85 unmodified lines | ||
| 86 | 86 | u32 clk_freq_out; |
| 87 | 87 | const struct geni_i2c_clk_fld *clk_fld; |
| 88 | 88 | int suspended; |
| 89 | + void *dma_buf; | |
| 90 | + size_t xfer_len; | |
| 91 | + dma_addr_t dma_addr; | |
| 89 | 92 | }; |
| 90 | 93 | |
| 91 | 94 | struct geni_i2c_err_log { |
| @@ -348,14 +351,65 @@ static void geni_i2c_tx_fsm_rst(struct geni_i2c_dev *gi2c) · 256 unmodified lines | ||
| 348 | 351 | dev_err(gi2c->se.dev, "Timeout resetting TX_FSM\n"); |
| 349 | 352 | } |
| 350 | 353 | |
| 354 | +static void geni_i2c_rx_msg_cleanup(struct geni_i2c_dev *gi2c, | |
| 355 | + struct i2c_msg *cur) | |
| 356 | +{ | |
| 357 | + gi2c->cur_rd = 0; | |
| 358 | + if (gi2c->dma_buf) { | |
| 359 | + if (gi2c->err) | |
| 360 | + geni_i2c_rx_fsm_rst(gi2c); | |
| 361 | + geni_se_rx_dma_unprep(&gi2c->se, gi2c->dma_addr, gi2c->xfer_len); | |
| 362 | + i2c_put_dma_safe_msg_buf(gi2c->dma_buf, cur, !gi2c->err); | |
| 363 | + } | |
| 364 | +} | |
| 365 | + | |
| 366 | +static void geni_i2c_tx_msg_cleanup(struct geni_i2c_dev *gi2c, | |
| 367 | + struct i2c_msg *cur) | |
| 368 | +{ | |
| 369 | + gi2c->cur_wr = 0; | |
| 370 | + if (gi2c->dma_buf) { | |
| 371 | + if (gi2c->err) | |
| 372 | + geni_i2c_tx_fsm_rst(gi2c); | |
| 373 | + geni_se_tx_dma_unprep(&gi2c->se, gi2c->dma_addr, gi2c->xfer_len); | |
| 374 | + i2c_put_dma_safe_msg_buf(gi2c->dma_buf, cur, !gi2c->err); | |
| 375 | + } | |
| 376 | +} | |
| 377 | + | |
| 378 | +static void geni_i2c_stop_xfer(struct geni_i2c_dev *gi2c) | |
| 379 | +{ | |
| 380 | + int ret; | |
| 381 | + u32 geni_status; | |
| 382 | + struct i2c_msg *cur; | |
| 383 | + | |
| 384 | + /* Resume device, as runtime suspend can happen anytime during transfer */ | |
| 385 | + ret = pm_runtime_get_sync(gi2c->se.dev); | |
| 386 | + if (ret < 0) { | |
| 387 | + dev_err(gi2c->se.dev, "Failed to resume device: %d\n", ret); | |
| 388 | + return; | |
| 389 | + } | |
| 390 | + | |
| 391 | + geni_status = readl_relaxed(gi2c->se.base + SE_GENI_STATUS); | |
| 392 | + if (geni_status & M_GENI_CMD_ACTIVE) { | |
| 393 | + cur = gi2c->cur; | |
| 394 | + geni_i2c_abort_xfer(gi2c); | |
| 395 | + if (cur->flags & I2C_M_RD) | |
| 396 | + geni_i2c_rx_msg_cleanup(gi2c, cur); | |
| 397 | + else | |
| 398 | + geni_i2c_tx_msg_cleanup(gi2c, cur); | |
| 399 | + } | |
| 400 | + | |
| 401 | + pm_runtime_put_sync_suspend(gi2c->se.dev); | |
| 402 | +} | |
| 403 | + | |
| 351 | 404 | static int geni_i2c_rx_one_msg(struct geni_i2c_dev *gi2c, struct i2c_msg *msg, |
| 352 | 405 | u32 m_param) |
| 353 | 406 | { |
| 354 | − dma_addr_t rx_dma; | |
| 407 | + dma_addr_t rx_dma = 0; | |
| 355 | 408 | unsigned long time_left; |
| 356 | 409 | void *dma_buf; |
| 357 | 410 | struct geni_se *se = &gi2c->se; |
| 358 | 411 | size_t len = msg->len; |
| 412 | + struct i2c_msg *cur; | |
| 359 | 413 | |
| 360 | 414 | dma_buf = i2c_get_dma_safe_msg_buf(msg, 32); |
| 361 | 415 | if (dma_buf) |
| @@ -370,19 +424,18 @@ static int geni_i2c_rx_one_msg(struct geni_i2c_dev *gi2c, struct i2c_msg *msg, · 8 unmodified lines | ||
| 370 | 424 | geni_se_select_mode(se, GENI_SE_FIFO); |
| 371 | 425 | i2c_put_dma_safe_msg_buf(dma_buf, msg, false); |
| 372 | 426 | dma_buf = NULL; |
| 427 | + } else { | |
| 428 | + gi2c->xfer_len = len; | |
| 429 | + gi2c->dma_addr = rx_dma; | |
| 430 | + gi2c->dma_buf = dma_buf; | |
| 373 | 431 | } |
| 374 | 432 | |
| 433 | + cur = gi2c->cur; | |
| 375 | 434 | time_left = wait_for_completion_timeout(&gi2c->done, XFER_TIMEOUT); |
| 376 | 435 | if (!time_left) |
| 377 | 436 | geni_i2c_abort_xfer(gi2c); |
| 378 | 437 | |
| 379 | − gi2c->cur_rd = 0; | |
| 380 | − if (dma_buf) { | |
| 381 | − if (gi2c->err) | |
| 382 | − geni_i2c_rx_fsm_rst(gi2c); | |
| 383 | − geni_se_rx_dma_unprep(se, rx_dma, len); | |
| 384 | − i2c_put_dma_safe_msg_buf(dma_buf, msg, !gi2c->err); | |
| 385 | − } | |
| 438 | + geni_i2c_rx_msg_cleanup(gi2c, cur); | |
| 386 | 439 | |
| 387 | 440 | return gi2c->err; |
| 388 | 441 | } |
| @@ -390,11 +443,12 @@ static int geni_i2c_rx_one_msg(struct geni_i2c_dev *gi2c, struct i2c_msg *msg, · 1 unmodified line | ||
| 390 | 443 | static int geni_i2c_tx_one_msg(struct geni_i2c_dev *gi2c, struct i2c_msg *msg, |
| 391 | 444 | u32 m_param) |
| 392 | 445 | { |
| 393 | − dma_addr_t tx_dma; | |
| 446 | + dma_addr_t tx_dma = 0; | |
| 394 | 447 | unsigned long time_left; |
| 395 | 448 | void *dma_buf; |
| 396 | 449 | struct geni_se *se = &gi2c->se; |
| 397 | 450 | size_t len = msg->len; |
| 451 | + struct i2c_msg *cur; | |
| 398 | 452 | |
| 399 | 453 | dma_buf = i2c_get_dma_safe_msg_buf(msg, 32); |
| 400 | 454 | if (dma_buf) |
| @@ -409,22 +463,21 @@ static int geni_i2c_tx_one_msg(struct geni_i2c_dev *gi2c, struct i2c_msg *msg, · 8 unmodified lines | ||
| 409 | 463 | geni_se_select_mode(se, GENI_SE_FIFO); |
| 410 | 464 | i2c_put_dma_safe_msg_buf(dma_buf, msg, false); |
| 411 | 465 | dma_buf = NULL; |
| 466 | + } else { | |
| 467 | + gi2c->xfer_len = len; | |
| 468 | + gi2c->dma_addr = tx_dma; | |
| 469 | + gi2c->dma_buf = dma_buf; | |
| 412 | 470 | } |
| 413 | 471 | |
| 414 | 472 | if (!dma_buf) /* Get FIFO IRQ */ |
| 415 | 473 | writel_relaxed(1, se->base + SE_GENI_TX_WATERMARK_REG); |
| 416 | 474 | |
| 475 | + cur = gi2c->cur; | |
| 417 | 476 | time_left = wait_for_completion_timeout(&gi2c->done, XFER_TIMEOUT); |
| 418 | 477 | if (!time_left) |
| 419 | 478 | geni_i2c_abort_xfer(gi2c); |
| 420 | 479 | |
| 421 | − gi2c->cur_wr = 0; | |
| 422 | − if (dma_buf) { | |
| 423 | − if (gi2c->err) | |
| 424 | − geni_i2c_tx_fsm_rst(gi2c); | |
| 425 | − geni_se_tx_dma_unprep(se, tx_dma, len); | |
| 426 | − i2c_put_dma_safe_msg_buf(dma_buf, msg, !gi2c->err); | |
| 427 | − } | |
| 480 | + geni_i2c_tx_msg_cleanup(gi2c, cur); | |
| 428 | 481 | |
| 429 | 482 | return gi2c->err; |
| 430 | 483 | } |
| @@ -623,6 +676,13 @@ static int geni_i2c_remove(struct platform_device *pdev) · 192 unmodified lines | ||
| 623 | 676 | return 0; |
| 624 | 677 | } |
| 625 | 678 | |
| 679 | +static void geni_i2c_shutdown(struct platform_device *pdev) | |
| 680 | +{ | |
| 681 | + struct geni_i2c_dev *gi2c = platform_get_drvdata(pdev); | |
| 682 | + | |
| 683 | + geni_i2c_stop_xfer(gi2c); | |
| 684 | +} | |
| 685 | + | |
| 626 | 686 | static int __maybe_unused geni_i2c_runtime_suspend(struct device *dev) |
| 627 | 687 | { |
| 628 | 688 | int ret; |
| @@ -687,6 +747,7 @@ MODULE_DEVICE_TABLE(of, geni_i2c_dt_match); · 58 unmodified lines | ||
| 687 | 747 | static struct platform_driver geni_i2c_driver = { |
| 688 | 748 | .probe = geni_i2c_probe, |
| 689 | 749 | .remove = geni_i2c_remove, |
| 750 | + .shutdown = geni_i2c_shutdown, | |
| 690 | 751 | .driver = { |
| 691 | 752 | .name = "geni_i2c", |
| 692 | 753 | .pm = &geni_i2c_pm_ops, |
| @@ -1603,7 +1603,7 @@ out: · 1602 unmodified lines | ||
| 1603 | 1603 | |
| 1604 | 1604 | static u32 qup_i2c_func(struct i2c_adapter *adap) |
| 1605 | 1605 | { |
| 1606 | − return I2C_FUNC_I2C | (I2C_FUNC_SMBUS_EMUL & ~I2C_FUNC_SMBUS_QUICK); | |
| 1606 | + return I2C_FUNC_I2C | (I2C_FUNC_SMBUS_EMUL_ALL & ~I2C_FUNC_SMBUS_QUICK); | |
| 1607 | 1607 | } |
| 1608 | 1608 | |
| 1609 | 1609 | static const struct i2c_algorithm qup_i2c_algo = { |
| @@ -91,7 +91,6 @@ · 90 unmodified lines | ||
| 91 | 91 | |
| 92 | 92 | #define RCAR_BUS_PHASE_START (MDBS | MIE | ESG) |
| 93 | 93 | #define RCAR_BUS_PHASE_DATA (MDBS | MIE) |
| 94 | −#define RCAR_BUS_MASK_DATA (~(ESG | FSB) & 0xFF) | |
| 95 | 94 | #define RCAR_BUS_PHASE_STOP (MDBS | MIE | FSB) |
| 96 | 95 | |
| 97 | 96 | #define RCAR_IRQ_SEND (MNR | MAL | MST | MAT | MDE) |
| @@ -120,6 +119,7 @@ enum rcar_i2c_type { · 22 unmodified lines | ||
| 120 | 119 | }; |
| 121 | 120 | |
| 122 | 121 | struct rcar_i2c_priv { |
| 122 | + u32 flags; | |
| 123 | 123 | void __iomem *io; |
| 124 | 124 | struct i2c_adapter adap; |
| 125 | 125 | struct i2c_msg *msg; |
| @@ -130,7 +130,6 @@ struct rcar_i2c_priv { · 4 unmodified lines | ||
| 130 | 130 | |
| 131 | 131 | int pos; |
| 132 | 132 | u32 icccr; |
| 133 | − u32 flags; | |
| 134 | 133 | u8 recovery_icmcr; /* protected by adapter lock */ |
| 135 | 134 | enum rcar_i2c_type devtype; |
| 136 | 135 | struct i2c_client *slave; |
| @@ -621,27 +620,16 @@ static bool rcar_i2c_slave_irq(struct rcar_i2c_priv *priv) · 484 unmodified lines | ||
| 621 | 620 | /* |
| 622 | 621 | * This driver has a lock-free design because there are IP cores (at least |
| 623 | 622 | * R-Car Gen2) which have an inherent race condition in their hardware design. |
| 624 | − * There, we need to clear RCAR_BUS_MASK_DATA bits as soon as possible after | |
| 623 | + * There, we need to switch to RCAR_BUS_PHASE_DATA as soon as possible after | |
| 625 | 624 | * the interrupt was generated, otherwise an unwanted repeated message gets |
| 626 | 625 | * generated. It turned out that taking a spinlock at the beginning of the ISR |
| 627 | 626 | * was already causing repeated messages. Thus, this driver was converted to |
| 628 | 627 | * the now lockless behaviour. Please keep this in mind when hacking the driver. |
| 628 | + * R-Car Gen3 seems to have this fixed but earlier versions than R-Car Gen2 are | |
| 629 | + * likely affected. Therefore, we have different interrupt handler entries. | |
| 629 | 630 | */ |
| 630 | −static irqreturn_t rcar_i2c_irq(int irq, void *ptr) | |
| 631 | +static irqreturn_t rcar_i2c_irq(int irq, struct rcar_i2c_priv *priv, u32 msr) | |
| 631 | 632 | { |
| 632 | − struct rcar_i2c_priv *priv = ptr; | |
| 633 | − u32 msr, val; | |
| 634 | − | |
| 635 | − /* Clear START or STOP immediately, except for REPSTART after read */ | |
| 636 | − if (likely(!(priv->flags & ID_P_REP_AFTER_RD))) { | |
| 637 | − val = rcar_i2c_read(priv, ICMCR); | |
| 638 | − rcar_i2c_write(priv, ICMCR, val & RCAR_BUS_MASK_DATA); | |
| 639 | − } | |
| 640 | − | |
| 641 | − msr = rcar_i2c_read(priv, ICMSR); | |
| 642 | − | |
| 643 | − /* Only handle interrupts that are currently enabled */ | |
| 644 | − msr &= rcar_i2c_read(priv, ICMIER); | |
| 645 | 633 | if (!msr) { |
| 646 | 634 | if (rcar_i2c_slave_irq(priv)) |
| 647 | 635 | return IRQ_HANDLED; |
| @@ -685,6 +673,41 @@ out: · 37 unmodified lines | ||
| 685 | 673 | return IRQ_HANDLED; |
| 686 | 674 | } |
| 687 | 675 | |
| 676 | +static irqreturn_t rcar_i2c_gen2_irq(int irq, void *ptr) | |
| 677 | +{ | |
| 678 | + struct rcar_i2c_priv *priv = ptr; | |
| 679 | + u32 msr; | |
| 680 | + | |
| 681 | + /* Clear START or STOP immediately, except for REPSTART after read */ | |
| 682 | + if (likely(!(priv->flags & ID_P_REP_AFTER_RD))) | |
| 683 | + rcar_i2c_write(priv, ICMCR, RCAR_BUS_PHASE_DATA); | |
| 684 | + | |
| 685 | + /* Only handle interrupts that are currently enabled */ | |
| 686 | + msr = rcar_i2c_read(priv, ICMSR); | |
| 687 | + msr &= rcar_i2c_read(priv, ICMIER); | |
| 688 | + | |
| 689 | + return rcar_i2c_irq(irq, priv, msr); | |
| 690 | +} | |
| 691 | + | |
| 692 | +static irqreturn_t rcar_i2c_gen3_irq(int irq, void *ptr) | |
| 693 | +{ | |
| 694 | + struct rcar_i2c_priv *priv = ptr; | |
| 695 | + u32 msr; | |
| 696 | + | |
| 697 | + /* Only handle interrupts that are currently enabled */ | |
| 698 | + msr = rcar_i2c_read(priv, ICMSR); | |
| 699 | + msr &= rcar_i2c_read(priv, ICMIER); | |
| 700 | + | |
| 701 | + /* | |
| 702 | + * Clear START or STOP immediately, except for REPSTART after read or | |
| 703 | + * if a spurious interrupt was detected. | |
| 704 | + */ | |
| 705 | + if (likely(!(priv->flags & ID_P_REP_AFTER_RD) && msr)) | |
| 706 | + rcar_i2c_write(priv, ICMCR, RCAR_BUS_PHASE_DATA); | |
| 707 | + | |
| 708 | + return rcar_i2c_irq(irq, priv, msr); | |
| 709 | +} | |
| 710 | + | |
| 688 | 711 | static struct dma_chan *rcar_i2c_request_dma_chan(struct device *dev, |
| 689 | 712 | enum dma_transfer_direction dir, |
| 690 | 713 | dma_addr_t port_addr) |
| @@ -931,6 +954,8 @@ static int rcar_i2c_probe(struct platform_device *pdev) · 240 unmodified lines | ||
| 931 | 954 | struct rcar_i2c_priv *priv; |
| 932 | 955 | struct i2c_adapter *adap; |
| 933 | 956 | struct device *dev = &pdev->dev; |
| 957 | + unsigned long irqflags = 0; | |
| 958 | + irqreturn_t (*irqhandler)(int irq, void *ptr) = rcar_i2c_gen3_irq; | |
| 934 | 959 | int ret; |
| 935 | 960 | |
| 936 | 961 | /* Otherwise logic will break because some bytes must always use PIO */ |
| @@ -979,6 +1004,11 @@ static int rcar_i2c_probe(struct platform_device *pdev) · 42 unmodified lines | ||
| 979 | 1004 | |
| 980 | 1005 | rcar_i2c_write(priv, ICSAR, 0); /* Gen2: must be 0 if not using slave */ |
| 981 | 1006 | |
| 1007 | + if (priv->devtype < I2C_RCAR_GEN3) { | |
| 1008 | + irqflags |= IRQF_NO_THREAD; | |
| 1009 | + irqhandler = rcar_i2c_gen2_irq; | |
| 1010 | + } | |
| 1011 | + | |
| 982 | 1012 | if (priv->devtype == I2C_RCAR_GEN3) { |
| 983 | 1013 | priv->rstc = devm_reset_control_get_exclusive(&pdev->dev, NULL); |
| 984 | 1014 | if (!IS_ERR(priv->rstc)) { |
| @@ -998,7 +1028,7 @@ static int rcar_i2c_probe(struct platform_device *pdev) · 13 unmodified lines | ||
| 998 | 1028 | priv->flags |= ID_P_HOST_NOTIFY; |
| 999 | 1029 | |
| 1000 | 1030 | priv->irq = platform_get_irq(pdev, 0); |
| 1001 | − ret = devm_request_irq(dev, priv->irq, rcar_i2c_irq, 0, dev_name(dev), priv); | |
| 1031 | + ret = devm_request_irq(dev, priv->irq, irqhandler, irqflags, dev_name(dev), priv); | |
| 1002 | 1032 | if (ret < 0) { |
| 1003 | 1033 | dev_err(dev, "cannot get irq %d\n", priv->irq); |
| 1004 | 1034 | goto out_pm_disable; |
| @@ -781,7 +781,7 @@ static int s3c24xx_i2c_xfer(struct i2c_adapter *adap, · 780 unmodified lines | ||
| 781 | 781 | /* declare our i2c functionality */ |
| 782 | 782 | static u32 s3c24xx_i2c_func(struct i2c_adapter *adap) |
| 783 | 783 | { |
| 784 | − return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL | I2C_FUNC_NOSTART | | |
| 784 | + return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL_ALL | I2C_FUNC_NOSTART | | |
| 785 | 785 | I2C_FUNC_PROTOCOL_MANGLING; |
| 786 | 786 | } |
| 787 | 787 | |
| @@ -1,475 +0,0 @@ | ||
| 1 | −// SPDX-License-Identifier: GPL-2.0-or-later | |
| 2 | −/* | |
| 3 | − * I2C bus driver for CSR SiRFprimaII | |
| 4 | − * | |
| 5 | − * Copyright (c) 2011 Cambridge Silicon Radio Limited, a CSR plc group company. | |
| 6 | − */ | |
| 7 | − | |
| 8 | −#include <linux/interrupt.h> | |
| 9 | −#include <linux/kernel.h> | |
| 10 | −#include <linux/module.h> | |
| 11 | −#include <linux/slab.h> | |
| 12 | −#include <linux/platform_device.h> | |
| 13 | −#include <linux/i2c.h> | |
| 14 | −#include <linux/clk.h> | |
| 15 | −#include <linux/err.h> | |
| 16 | −#include <linux/io.h> | |
| 17 | − | |
| 18 | −#define SIRFSOC_I2C_CLK_CTRL 0x00 | |
| 19 | −#define SIRFSOC_I2C_STATUS 0x0C | |
| 20 | −#define SIRFSOC_I2C_CTRL 0x10 | |
| 21 | −#define SIRFSOC_I2C_IO_CTRL 0x14 | |
| 22 | −#define SIRFSOC_I2C_SDA_DELAY 0x18 | |
| 23 | −#define SIRFSOC_I2C_CMD_START 0x1C | |
| 24 | −#define SIRFSOC_I2C_CMD_BUF 0x30 | |
| 25 | −#define SIRFSOC_I2C_DATA_BUF 0x80 | |
| 26 | − | |
| 27 | −#define SIRFSOC_I2C_CMD_BUF_MAX 16 | |
| 28 | −#define SIRFSOC_I2C_DATA_BUF_MAX 16 | |
| 29 | − | |
| 30 | −#define SIRFSOC_I2C_CMD(x) (SIRFSOC_I2C_CMD_BUF + (x)*0x04) | |
| 31 | −#define SIRFSOC_I2C_DATA_MASK(x) (0xFF<<(((x)&3)*8)) | |
| 32 | −#define SIRFSOC_I2C_DATA_SHIFT(x) (((x)&3)*8) | |
| 33 | − | |
| 34 | −#define SIRFSOC_I2C_DIV_MASK (0xFFFF) | |
| 35 | − | |
| 36 | −/* I2C status flags */ | |
| 37 | −#define SIRFSOC_I2C_STAT_BUSY BIT(0) | |
| 38 | −#define SIRFSOC_I2C_STAT_TIP BIT(1) | |
| 39 | −#define SIRFSOC_I2C_STAT_NACK BIT(2) | |
| 40 | −#define SIRFSOC_I2C_STAT_TR_INT BIT(4) | |
| 41 | −#define SIRFSOC_I2C_STAT_STOP BIT(6) | |
| 42 | −#define SIRFSOC_I2C_STAT_CMD_DONE BIT(8) | |
| 43 | −#define SIRFSOC_I2C_STAT_ERR BIT(9) | |
| 44 | −#define SIRFSOC_I2C_CMD_INDEX (0x1F<<16) | |
| 45 | − | |
| 46 | −/* I2C control flags */ | |
| 47 | −#define SIRFSOC_I2C_RESET BIT(0) | |
| 48 | −#define SIRFSOC_I2C_CORE_EN BIT(1) | |
| 49 | −#define SIRFSOC_I2C_MASTER_MODE BIT(2) | |
| 50 | −#define SIRFSOC_I2C_CMD_DONE_EN BIT(11) | |
| 51 | −#define SIRFSOC_I2C_ERR_INT_EN BIT(12) | |
| 52 | − | |
| 53 | −#define SIRFSOC_I2C_SDA_DELAY_MASK (0xFF) | |
| 54 | −#define SIRFSOC_I2C_SCLF_FILTER (3<<8) | |
| 55 | − | |
| 56 | −#define SIRFSOC_I2C_START_CMD BIT(0) | |
| 57 | − | |
| 58 | −#define SIRFSOC_I2C_CMD_RP(x) ((x)&0x7) | |
| 59 | −#define SIRFSOC_I2C_NACK BIT(3) | |
| 60 | −#define SIRFSOC_I2C_WRITE BIT(4) | |
| 61 | −#define SIRFSOC_I2C_READ BIT(5) | |
| 62 | −#define SIRFSOC_I2C_STOP BIT(6) | |
| 63 | −#define SIRFSOC_I2C_START BIT(7) | |
| 64 | − | |
| 65 | −#define SIRFSOC_I2C_ERR_NOACK 1 | |
| 66 | −#define SIRFSOC_I2C_ERR_TIMEOUT 2 | |
| 67 | − | |
| 68 | −struct sirfsoc_i2c { | |
| 69 | − void __iomem *base; | |
| 70 | − struct clk *clk; | |
| 71 | − u32 cmd_ptr; /* Current position in CMD buffer */ | |
| 72 | − u8 *buf; /* Buffer passed by user */ | |
| 73 | − u32 msg_len; /* Message length */ | |
| 74 | − u32 finished_len; /* number of bytes read/written */ | |
| 75 | − u32 read_cmd_len; /* number of read cmd sent */ | |
| 76 | − int msg_read; /* 1 indicates a read message */ | |
| 77 | − int err_status; /* 1 indicates an error on bus */ | |
| 78 | − | |
| 79 | − u32 sda_delay; /* For suspend/resume */ | |
| 80 | − u32 clk_div; | |
| 81 | − int last; /* Last message in transfer, STOP cmd can be sent */ | |
| 82 | − | |
| 83 | − struct completion done; /* indicates completion of message transfer */ | |
| 84 | − struct i2c_adapter adapter; | |
| 85 | −}; | |
| 86 | − | |
| 87 | −static void i2c_sirfsoc_read_data(struct sirfsoc_i2c *siic) | |
| 88 | −{ | |
| 89 | − u32 data = 0; | |
| 90 | − int i; | |
| 91 | − | |
| 92 | − for (i = 0; i < siic->read_cmd_len; i++) { | |
| 93 | − if (!(i & 0x3)) | |
| 94 | − data = readl(siic->base + SIRFSOC_I2C_DATA_BUF + i); | |
| 95 | − siic->buf[siic->finished_len++] = | |
| 96 | − (u8)((data & SIRFSOC_I2C_DATA_MASK(i)) >> | |
| 97 | − SIRFSOC_I2C_DATA_SHIFT(i)); | |
| 98 | − } | |
| 99 | −} | |
| 100 | − | |
| 101 | −static void i2c_sirfsoc_queue_cmd(struct sirfsoc_i2c *siic) | |
| 102 | −{ | |
| 103 | − u32 regval; | |
| 104 | − int i = 0; | |
| 105 | − | |
| 106 | − if (siic->msg_read) { | |
| 107 | − while (((siic->finished_len + i) < siic->msg_len) | |
| 108 | − && (siic->cmd_ptr < SIRFSOC_I2C_CMD_BUF_MAX)) { | |
| 109 | − regval = SIRFSOC_I2C_READ | SIRFSOC_I2C_CMD_RP(0); | |
| 110 | − if (((siic->finished_len + i) == | |
| 111 | − (siic->msg_len - 1)) && siic->last) | |
| 112 | − regval |= SIRFSOC_I2C_STOP | SIRFSOC_I2C_NACK; | |
| 113 | − writel(regval, | |
| 114 | − siic->base + SIRFSOC_I2C_CMD(siic->cmd_ptr++)); | |
| 115 | − i++; | |
| 116 | − } | |
| 117 | − | |
| 118 | − siic->read_cmd_len = i; | |
| 119 | − } else { | |
| 120 | − while ((siic->cmd_ptr < SIRFSOC_I2C_CMD_BUF_MAX - 1) | |
| 121 | − && (siic->finished_len < siic->msg_len)) { | |
| 122 | − regval = SIRFSOC_I2C_WRITE | SIRFSOC_I2C_CMD_RP(0); | |
| 123 | − if ((siic->finished_len == (siic->msg_len - 1)) | |
| 124 | − && siic->last) | |
| 125 | − regval |= SIRFSOC_I2C_STOP; | |
| 126 | − writel(regval, | |
| 127 | − siic->base + SIRFSOC_I2C_CMD(siic->cmd_ptr++)); | |
| 128 | − writel(siic->buf[siic->finished_len++], | |
| 129 | − siic->base + SIRFSOC_I2C_CMD(siic->cmd_ptr++)); | |
| 130 | − } | |
| 131 | − } | |
| 132 | − siic->cmd_ptr = 0; | |
| 133 | − | |
| 134 | − /* Trigger the transfer */ | |
| 135 | − writel(SIRFSOC_I2C_START_CMD, siic->base + SIRFSOC_I2C_CMD_START); | |
| 136 | −} | |
| 137 | − | |
| 138 | −static irqreturn_t i2c_sirfsoc_irq(int irq, void *dev_id) | |
| 139 | −{ | |
| 140 | − struct sirfsoc_i2c *siic = (struct sirfsoc_i2c *)dev_id; | |
| 141 | − u32 i2c_stat = readl(siic->base + SIRFSOC_I2C_STATUS); | |
| 142 | − | |
| 143 | − if (i2c_stat & SIRFSOC_I2C_STAT_ERR) { | |
| 144 | − /* Error conditions */ | |
| 145 | − siic->err_status = SIRFSOC_I2C_ERR_NOACK; | |
| 146 | − writel(SIRFSOC_I2C_STAT_ERR, siic->base + SIRFSOC_I2C_STATUS); | |
| 147 | − | |
| 148 | − if (i2c_stat & SIRFSOC_I2C_STAT_NACK) | |
| 149 | − dev_dbg(&siic->adapter.dev, "ACK not received\n"); | |
| 150 | − else | |
| 151 | − dev_err(&siic->adapter.dev, "I2C error\n"); | |
| 152 | − | |
| 153 | − /* | |
| 154 | − * Due to hardware ANOMALY, we need to reset I2C earlier after | |
| 155 | − * we get NOACK while accessing non-existing clients, otherwise | |
| 156 | − * we will get errors even we access existing clients later | |
| 157 | − */ | |
| 158 | − writel(readl(siic->base + SIRFSOC_I2C_CTRL) | SIRFSOC_I2C_RESET, | |
| 159 | − siic->base + SIRFSOC_I2C_CTRL); | |
| 160 | − while (readl(siic->base + SIRFSOC_I2C_CTRL) & SIRFSOC_I2C_RESET) | |
| 161 | − cpu_relax(); | |
| 162 | − | |
| 163 | − complete(&siic->done); | |
| 164 | − } else if (i2c_stat & SIRFSOC_I2C_STAT_CMD_DONE) { | |
| 165 | − /* CMD buffer execution complete */ | |
| 166 | − if (siic->msg_read) | |
| 167 | − i2c_sirfsoc_read_data(siic); | |
| 168 | − if (siic->finished_len == siic->msg_len) | |
| 169 | − complete(&siic->done); | |
| 170 | − else /* Fill a new CMD buffer for left data */ | |
| 171 | − i2c_sirfsoc_queue_cmd(siic); | |
| 172 | − | |
| 173 | − writel(SIRFSOC_I2C_STAT_CMD_DONE, siic->base + SIRFSOC_I2C_STATUS); | |
| 174 | − } | |
| 175 | − | |
| 176 | − return IRQ_HANDLED; | |
| 177 | −} | |
| 178 | − | |
| 179 | −static void i2c_sirfsoc_set_address(struct sirfsoc_i2c *siic, | |
| 180 | − struct i2c_msg *msg) | |
| 181 | −{ | |
| 182 | − unsigned char addr; | |
| 183 | − u32 regval = SIRFSOC_I2C_START | SIRFSOC_I2C_CMD_RP(0) | SIRFSOC_I2C_WRITE; | |
| 184 | − | |
| 185 | − /* no data and last message -> add STOP */ | |
| 186 | − if (siic->last && (msg->len == 0)) | |
| 187 | − regval |= SIRFSOC_I2C_STOP; | |
| 188 | − | |
| 189 | − writel(regval, siic->base + SIRFSOC_I2C_CMD(siic->cmd_ptr++)); | |
| 190 | − | |
| 191 | − addr = i2c_8bit_addr_from_msg(msg); | |
| 192 | − | |
| 193 | − /* Reverse direction bit */ | |
| 194 | − if (msg->flags & I2C_M_REV_DIR_ADDR) | |
| 195 | − addr ^= 1; | |
| 196 | − | |
| 197 | − writel(addr, siic->base + SIRFSOC_I2C_CMD(siic->cmd_ptr++)); | |
| 198 | −} | |
| 199 | − | |
| 200 | −static int i2c_sirfsoc_xfer_msg(struct sirfsoc_i2c *siic, struct i2c_msg *msg) | |
| 201 | −{ | |
| 202 | − u32 regval = readl(siic->base + SIRFSOC_I2C_CTRL); | |
| 203 | − /* timeout waiting for the xfer to finish or fail */ | |
| 204 | − int timeout = msecs_to_jiffies((msg->len + 1) * 50); | |
| 205 | − | |
| 206 | − i2c_sirfsoc_set_address(siic, msg); | |
| 207 | − | |
| 208 | − writel(regval | SIRFSOC_I2C_CMD_DONE_EN | SIRFSOC_I2C_ERR_INT_EN, | |
| 209 | − siic->base + SIRFSOC_I2C_CTRL); | |
| 210 | − i2c_sirfsoc_queue_cmd(siic); | |
| 211 | − | |
| 212 | − if (wait_for_completion_timeout(&siic->done, timeout) == 0) { | |
| 213 | − siic->err_status = SIRFSOC_I2C_ERR_TIMEOUT; | |
| 214 | − dev_err(&siic->adapter.dev, "Transfer timeout\n"); | |
| 215 | − } | |
| 216 | − | |
| 217 | − writel(regval & ~(SIRFSOC_I2C_CMD_DONE_EN | SIRFSOC_I2C_ERR_INT_EN), | |
| 218 | − siic->base + SIRFSOC_I2C_CTRL); | |
| 219 | − writel(0, siic->base + SIRFSOC_I2C_CMD_START); | |
| 220 | − | |
| 221 | − /* i2c control doesn't response, reset it */ | |
| 222 | − if (siic->err_status == SIRFSOC_I2C_ERR_TIMEOUT) { | |
| 223 | − writel(readl(siic->base + SIRFSOC_I2C_CTRL) | SIRFSOC_I2C_RESET, | |
| 224 | − siic->base + SIRFSOC_I2C_CTRL); | |
| 225 | − while (readl(siic->base + SIRFSOC_I2C_CTRL) & SIRFSOC_I2C_RESET) | |
| 226 | − cpu_relax(); | |
| 227 | − } | |
| 228 | − return siic->err_status ? -EAGAIN : 0; | |
| 229 | −} | |
| 230 | − | |
| 231 | −static u32 i2c_sirfsoc_func(struct i2c_adapter *adap) | |
| 232 | −{ | |
| 233 | − return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL; | |
| 234 | −} | |
| 235 | − | |
| 236 | −static int i2c_sirfsoc_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs, | |
| 237 | − int num) | |
| 238 | −{ | |
| 239 | − struct sirfsoc_i2c *siic = adap->algo_data; | |
| 240 | − int i, ret; | |
| 241 | − | |
| 242 | − clk_enable(siic->clk); | |
| 243 | − | |
| 244 | − for (i = 0; i < num; i++) { | |
| 245 | − siic->buf = msgs[i].buf; | |
| 246 | − siic->msg_len = msgs[i].len; | |
| 247 | − siic->msg_read = !!(msgs[i].flags & I2C_M_RD); | |
| 248 | − siic->err_status = 0; | |
| 249 | − siic->cmd_ptr = 0; | |
| 250 | − siic->finished_len = 0; | |
| 251 | − siic->last = (i == (num - 1)); | |
| 252 | − | |
| 253 | − ret = i2c_sirfsoc_xfer_msg(siic, &msgs[i]); | |
| 254 | − if (ret) { | |
| 255 | − clk_disable(siic->clk); | |
| 256 | − return ret; | |
| 257 | − } | |
| 258 | − } | |
| 259 | − | |
| 260 | − clk_disable(siic->clk); | |
| 261 | − return num; | |
| 262 | −} | |
| 263 | − | |
| 264 | −/* I2C algorithms associated with this master controller driver */ | |
| 265 | −static const struct i2c_algorithm i2c_sirfsoc_algo = { | |
| 266 | − .master_xfer = i2c_sirfsoc_xfer, | |
| 267 | − .functionality = i2c_sirfsoc_func, | |
| 268 | −}; | |
| 269 | − | |
| 270 | −static int i2c_sirfsoc_probe(struct platform_device *pdev) | |
| 271 | −{ | |
| 272 | − struct sirfsoc_i2c *siic; | |
| 273 | − struct i2c_adapter *adap; | |
| 274 | − struct clk *clk; | |
| 275 | − int bitrate; | |
| 276 | − int ctrl_speed; | |
| 277 | − int irq; | |
| 278 | − | |
| 279 | − int err; | |
| 280 | − u32 regval; | |
| 281 | − | |
| 282 | − clk = clk_get(&pdev->dev, NULL); | |
| 283 | − if (IS_ERR(clk)) { | |
| 284 | − err = PTR_ERR(clk); | |
| 285 | − dev_err(&pdev->dev, "Clock get failed\n"); | |
| 286 | − goto err_get_clk; | |
| 287 | − } | |
| 288 | − | |
| 289 | − err = clk_prepare(clk); | |
| 290 | − if (err) { | |
| 291 | − dev_err(&pdev->dev, "Clock prepare failed\n"); | |
| 292 | − goto err_clk_prep; | |
| 293 | − } | |
| 294 | − | |
| 295 | − err = clk_enable(clk); | |
| 296 | − if (err) { | |
| 297 | − dev_err(&pdev->dev, "Clock enable failed\n"); | |
| 298 | − goto err_clk_en; | |
| 299 | − } | |
| 300 | − | |
| 301 | − ctrl_speed = clk_get_rate(clk); | |
| 302 | − | |
| 303 | − siic = devm_kzalloc(&pdev->dev, sizeof(*siic), GFP_KERNEL); | |
| 304 | − if (!siic) { | |
| 305 | − err = -ENOMEM; | |
| 306 | − goto out; | |
| 307 | − } | |
| 308 | − adap = &siic->adapter; | |
| 309 | − adap->class = I2C_CLASS_DEPRECATED; | |
| 310 | − | |
| 311 | − siic->base = devm_platform_ioremap_resource(pdev, 0); | |
| 312 | − if (IS_ERR(siic->base)) { | |
| 313 | − err = PTR_ERR(siic->base); | |
| 314 | − goto out; | |
| 315 | − } | |
| 316 | − | |
| 317 | − irq = platform_get_irq(pdev, 0); | |
| 318 | − if (irq < 0) { | |
| 319 | − err = irq; | |
| 320 | − goto out; | |
| 321 | − } | |
| 322 | − err = devm_request_irq(&pdev->dev, irq, i2c_sirfsoc_irq, 0, | |
| 323 | − dev_name(&pdev->dev), siic); | |
| 324 | − if (err) | |
| 325 | − goto out; | |
| 326 | − | |
| 327 | − adap->algo = &i2c_sirfsoc_algo; | |
| 328 | − adap->algo_data = siic; | |
| 329 | − adap->retries = 3; | |
| 330 | − | |
| 331 | − adap->dev.of_node = pdev->dev.of_node; | |
| 332 | − adap->dev.parent = &pdev->dev; | |
| 333 | − adap->nr = pdev->id; | |
| 334 | − | |
| 335 | − strlcpy(adap->name, "sirfsoc-i2c", sizeof(adap->name)); | |
| 336 | − | |
| 337 | − platform_set_drvdata(pdev, adap); | |
| 338 | − init_completion(&siic->done); | |
| 339 | − | |
| 340 | − /* Controller initialisation */ | |
| 341 | − | |
| 342 | − writel(SIRFSOC_I2C_RESET, siic->base + SIRFSOC_I2C_CTRL); | |
| 343 | − while (readl(siic->base + SIRFSOC_I2C_CTRL) & SIRFSOC_I2C_RESET) | |
| 344 | − cpu_relax(); | |
| 345 | − writel(SIRFSOC_I2C_CORE_EN | SIRFSOC_I2C_MASTER_MODE, | |
| 346 | − siic->base + SIRFSOC_I2C_CTRL); | |
| 347 | − | |
| 348 | − siic->clk = clk; | |
| 349 | − | |
| 350 | − err = of_property_read_u32(pdev->dev.of_node, | |
| 351 | − "clock-frequency", &bitrate); | |
| 352 | − if (err < 0) | |
| 353 | − bitrate = I2C_MAX_STANDARD_MODE_FREQ; | |
| 354 | − | |
| 355 | − /* | |
| 356 | − * Due to some hardware design issues, we need to tune the formula. | |
| 357 | − * Since i2c is open drain interface that allows the slave to | |
| 358 | − * stall the transaction by holding the SCL line at '0', the RTL | |
| 359 | − * implementation is waiting for SCL feedback from the pin after | |
| 360 | − * setting it to High-Z ('1'). This wait adds to the high-time | |
| 361 | − * interval counter few cycles of the input synchronization | |
| 362 | − * (depending on the SCL_FILTER_REG field), and also the time it | |
| 363 | − * takes for the board pull-up resistor to rise the SCL line. | |
| 364 | − * For slow SCL settings these additions are negligible, | |
| 365 | − * but they start to affect the speed when clock is set to faster | |
| 366 | − * frequencies. | |
| 367 | − * Through the actual tests, use the different user_div value(which | |
| 368 | − * in the divider formula 'Fio / (Fi2c * user_div)') to adapt | |
| 369 | − * the different ranges of i2c bus clock frequency, to make the SCL | |
| 370 | − * more accurate. | |
| 371 | − */ | |
| 372 | − if (bitrate <= 30000) | |
| 373 | − regval = ctrl_speed / (bitrate * 5); | |
| 374 | − else if (bitrate > 30000 && bitrate <= 280000) | |
| 375 | − regval = (2 * ctrl_speed) / (bitrate * 11); | |
| 376 | − else | |
| 377 | − regval = ctrl_speed / (bitrate * 6); | |
| 378 | − | |
| 379 | − writel(regval, siic->base + SIRFSOC_I2C_CLK_CTRL); | |
| 380 | − if (regval > 0xFF) | |
| 381 | − writel(0xFF, siic->base + SIRFSOC_I2C_SDA_DELAY); | |
| 382 | − else | |
| 383 | − writel(regval, siic->base + SIRFSOC_I2C_SDA_DELAY); | |
| 384 | − | |
| 385 | − err = i2c_add_numbered_adapter(adap); | |
| 386 | − if (err < 0) | |
| 387 | − goto out; | |
| 388 | − | |
| 389 | − clk_disable(clk); | |
| 390 | − | |
| 391 | − dev_info(&pdev->dev, " I2C adapter ready to operate\n"); | |
| 392 | − | |
| 393 | − return 0; | |
| 394 | − | |
| 395 | −out: | |
| 396 | − clk_disable(clk); | |
| 397 | −err_clk_en: | |
| 398 | − clk_unprepare(clk); | |
| 399 | −err_clk_prep: | |
| 400 | − clk_put(clk); | |
| 401 | −err_get_clk: | |
| 402 | − return err; | |
| 403 | −} | |
| 404 | − | |
| 405 | −static int i2c_sirfsoc_remove(struct platform_device *pdev) | |
| 406 | −{ | |
| 407 | − struct i2c_adapter *adapter = platform_get_drvdata(pdev); | |
| 408 | − struct sirfsoc_i2c *siic = adapter->algo_data; | |
| 409 | − | |
| 410 | − writel(SIRFSOC_I2C_RESET, siic->base + SIRFSOC_I2C_CTRL); | |
| 411 | − i2c_del_adapter(adapter); | |
| 412 | − clk_unprepare(siic->clk); | |
| 413 | − clk_put(siic->clk); | |
| 414 | − return 0; | |
| 415 | −} | |
| 416 | − | |
| 417 | −#ifdef CONFIG_PM | |
| 418 | −static int i2c_sirfsoc_suspend(struct device *dev) | |
| 419 | −{ | |
| 420 | − struct i2c_adapter *adapter = dev_get_drvdata(dev); | |
| 421 | − struct sirfsoc_i2c *siic = adapter->algo_data; | |
| 422 | − | |
| 423 | − clk_enable(siic->clk); | |
| 424 | − siic->sda_delay = readl(siic->base + SIRFSOC_I2C_SDA_DELAY); | |
| 425 | − siic->clk_div = readl(siic->base + SIRFSOC_I2C_CLK_CTRL); | |
| 426 | − clk_disable(siic->clk); | |
| 427 | − return 0; | |
| 428 | −} | |
| 429 | − | |
| 430 | −static int i2c_sirfsoc_resume(struct device *dev) | |
| 431 | −{ | |
| 432 | − struct i2c_adapter *adapter = dev_get_drvdata(dev); | |
| 433 | − struct sirfsoc_i2c *siic = adapter->algo_data; | |
| 434 | − | |
| 435 | − clk_enable(siic->clk); | |
| 436 | − writel(SIRFSOC_I2C_RESET, siic->base + SIRFSOC_I2C_CTRL); | |
| 437 | − while (readl(siic->base + SIRFSOC_I2C_CTRL) & SIRFSOC_I2C_RESET) | |
| 438 | − cpu_relax(); | |
| 439 | − writel(SIRFSOC_I2C_CORE_EN | SIRFSOC_I2C_MASTER_MODE, | |
| 440 | − siic->base + SIRFSOC_I2C_CTRL); | |
| 441 | − writel(siic->clk_div, siic->base + SIRFSOC_I2C_CLK_CTRL); | |
| 442 | − writel(siic->sda_delay, siic->base + SIRFSOC_I2C_SDA_DELAY); | |
| 443 | − clk_disable(siic->clk); | |
| 444 | − return 0; | |
| 445 | −} | |
| 446 | − | |
| 447 | −static const struct dev_pm_ops i2c_sirfsoc_pm_ops = { | |
| 448 | − .suspend = i2c_sirfsoc_suspend, | |
| 449 | − .resume = i2c_sirfsoc_resume, | |
| 450 | −}; | |
| 451 | −#endif | |
| 452 | − | |
| 453 | −static const struct of_device_id sirfsoc_i2c_of_match[] = { | |
| 454 | − { .compatible = "sirf,prima2-i2c", }, | |
| 455 | − {}, | |
| 456 | −}; | |
| 457 | −MODULE_DEVICE_TABLE(of, sirfsoc_i2c_of_match); | |
| 458 | − | |
| 459 | −static struct platform_driver i2c_sirfsoc_driver = { | |
| 460 | − .driver = { | |
| 461 | − .name = "sirfsoc_i2c", | |
| 462 | −#ifdef CONFIG_PM | |
| 463 | − .pm = &i2c_sirfsoc_pm_ops, | |
| 464 | −#endif | |
| 465 | − .of_match_table = sirfsoc_i2c_of_match, | |
| 466 | − }, | |
| 467 | − .probe = i2c_sirfsoc_probe, | |
| 468 | − .remove = i2c_sirfsoc_remove, | |
| 469 | −}; | |
| 470 | −module_platform_driver(i2c_sirfsoc_driver); | |
| 471 | − | |
| 472 | −MODULE_DESCRIPTION("SiRF SoC I2C master controller driver"); | |
| 473 | −MODULE_AUTHOR("Zhiwu Song <Zhiwu.Song@csr.com>"); | |
| 474 | −MODULE_AUTHOR("Xiangzhen Ye <Xiangzhen.Ye@csr.com>"); | |
| 475 | −MODULE_LICENSE("GPL v2"); | |
| @@ -2035,12 +2035,8 @@ static int stm32f7_i2c_probe(struct platform_device *pdev) · 2034 unmodified lines | ||
| 2035 | 2035 | } |
| 2036 | 2036 | |
| 2037 | 2037 | irq_error = platform_get_irq(pdev, 1); |
| 2038 | − if (irq_error <= 0) { | |
| 2039 | − if (irq_error != -EPROBE_DEFER) | |
| 2040 | − dev_err(&pdev->dev, "Failed to get IRQ error: %d\n", | |
| 2041 | − irq_error); | |
| 2038 | + if (irq_error <= 0) | |
| 2042 | 2039 | return irq_error ? : -ENOENT; |
| 2043 | − } | |
| 2044 | 2040 | |
| 2045 | 2041 | i2c_dev->wakeup_src = of_property_read_bool(pdev->dev.of_node, |
| 2046 | 2042 | "wakeup-source"); |
| @@ -1,1008 +0,0 @@ | ||
| 1 | −// SPDX-License-Identifier: GPL-2.0-only | |
| 2 | −/* | |
| 3 | − * Copyright (C) 2007-2012 ST-Ericsson AB | |
| 4 | − * ST DDC I2C master mode driver, used in e.g. U300 series platforms. | |
| 5 | − * Author: Linus Walleij <linus.walleij@stericsson.com> | |
| 6 | − * Author: Jonas Aaberg <jonas.aberg@stericsson.com> | |
| 7 | − */ | |
| 8 | −#include <linux/init.h> | |
| 9 | −#include <linux/module.h> | |
| 10 | −#include <linux/platform_device.h> | |
| 11 | −#include <linux/delay.h> | |
| 12 | −#include <linux/i2c.h> | |
| 13 | −#include <linux/spinlock.h> | |
| 14 | −#include <linux/completion.h> | |
| 15 | −#include <linux/err.h> | |
| 16 | −#include <linux/interrupt.h> | |
| 17 | −#include <linux/clk.h> | |
| 18 | −#include <linux/io.h> | |
| 19 | −#include <linux/slab.h> | |
| 20 | − | |
| 21 | −/* the name of this kernel module */ | |
| 22 | −#define NAME "stu300" | |
| 23 | − | |
| 24 | −/* CR (Control Register) 8bit (R/W) */ | |
| 25 | −#define I2C_CR (0x00000000) | |
| 26 | −#define I2C_CR_RESET_VALUE (0x00) | |
| 27 | −#define I2C_CR_RESET_UMASK (0x00) | |
| 28 | −#define I2C_CR_DDC1_ENABLE (0x80) | |
| 29 | −#define I2C_CR_TRANS_ENABLE (0x40) | |
| 30 | −#define I2C_CR_PERIPHERAL_ENABLE (0x20) | |
| 31 | −#define I2C_CR_DDC2B_ENABLE (0x10) | |
| 32 | −#define I2C_CR_START_ENABLE (0x08) | |
| 33 | −#define I2C_CR_ACK_ENABLE (0x04) | |
| 34 | −#define I2C_CR_STOP_ENABLE (0x02) | |
| 35 | −#define I2C_CR_INTERRUPT_ENABLE (0x01) | |
| 36 | −/* SR1 (Status Register 1) 8bit (R/-) */ | |
| 37 | −#define I2C_SR1 (0x00000004) | |
| 38 | −#define I2C_SR1_RESET_VALUE (0x00) | |
| 39 | −#define I2C_SR1_RESET_UMASK (0x00) | |
| 40 | −#define I2C_SR1_EVF_IND (0x80) | |
| 41 | −#define I2C_SR1_ADD10_IND (0x40) | |
| 42 | −#define I2C_SR1_TRA_IND (0x20) | |
| 43 | −#define I2C_SR1_BUSY_IND (0x10) | |
| 44 | −#define I2C_SR1_BTF_IND (0x08) | |
| 45 | −#define I2C_SR1_ADSL_IND (0x04) | |
| 46 | −#define I2C_SR1_MSL_IND (0x02) | |
| 47 | −#define I2C_SR1_SB_IND (0x01) | |
| 48 | −/* SR2 (Status Register 2) 8bit (R/-) */ | |
| 49 | −#define I2C_SR2 (0x00000008) | |
| 50 | −#define I2C_SR2_RESET_VALUE (0x00) | |
| 51 | −#define I2C_SR2_RESET_UMASK (0x40) | |
| 52 | −#define I2C_SR2_MASK (0xBF) | |
| 53 | −#define I2C_SR2_SCLFAL_IND (0x80) | |
| 54 | −#define I2C_SR2_ENDAD_IND (0x20) | |
| 55 | −#define I2C_SR2_AF_IND (0x10) | |
| 56 | −#define I2C_SR2_STOPF_IND (0x08) | |
| 57 | −#define I2C_SR2_ARLO_IND (0x04) | |
| 58 | −#define I2C_SR2_BERR_IND (0x02) | |
| 59 | −#define I2C_SR2_DDC2BF_IND (0x01) | |
| 60 | −/* CCR (Clock Control Register) 8bit (R/W) */ | |
| 61 | −#define I2C_CCR (0x0000000C) | |
| 62 | −#define I2C_CCR_RESET_VALUE (0x00) | |
| 63 | −#define I2C_CCR_RESET_UMASK (0x00) | |
| 64 | −#define I2C_CCR_MASK (0xFF) | |
| 65 | −#define I2C_CCR_FMSM (0x80) | |
| 66 | −#define I2C_CCR_CC_MASK (0x7F) | |
| 67 | −/* OAR1 (Own Address Register 1) 8bit (R/W) */ | |
| 68 | −#define I2C_OAR1 (0x00000010) | |
| 69 | −#define I2C_OAR1_RESET_VALUE (0x00) | |
| 70 | −#define I2C_OAR1_RESET_UMASK (0x00) | |
| 71 | −#define I2C_OAR1_ADD_MASK (0xFF) | |
| 72 | −/* OAR2 (Own Address Register 2) 8bit (R/W) */ | |
| 73 | −#define I2C_OAR2 (0x00000014) | |
| 74 | −#define I2C_OAR2_RESET_VALUE (0x40) | |
| 75 | −#define I2C_OAR2_RESET_UMASK (0x19) | |
| 76 | −#define I2C_OAR2_MASK (0xE6) | |
| 77 | −#define I2C_OAR2_FR_25_10MHZ (0x00) | |
| 78 | −#define I2C_OAR2_FR_10_1667MHZ (0x20) | |
| 79 | −#define I2C_OAR2_FR_1667_2667MHZ (0x40) | |
| 80 | −#define I2C_OAR2_FR_2667_40MHZ (0x60) | |
| 81 | −#define I2C_OAR2_FR_40_5333MHZ (0x80) | |
| 82 | −#define I2C_OAR2_FR_5333_66MHZ (0xA0) | |
| 83 | −#define I2C_OAR2_FR_66_80MHZ (0xC0) | |
| 84 | −#define I2C_OAR2_FR_80_100MHZ (0xE0) | |
| 85 | −#define I2C_OAR2_FR_MASK (0xE0) | |
| 86 | −#define I2C_OAR2_ADD_MASK (0x06) | |
| 87 | −/* DR (Data Register) 8bit (R/W) */ | |
| 88 | −#define I2C_DR (0x00000018) | |
| 89 | −#define I2C_DR_RESET_VALUE (0x00) | |
| 90 | −#define I2C_DR_RESET_UMASK (0xFF) | |
| 91 | −#define I2C_DR_D_MASK (0xFF) | |
| 92 | −/* ECCR (Extended Clock Control Register) 8bit (R/W) */ | |
| 93 | −#define I2C_ECCR (0x0000001C) | |
| 94 | −#define I2C_ECCR_RESET_VALUE (0x00) | |
| 95 | −#define I2C_ECCR_RESET_UMASK (0xE0) | |
| 96 | −#define I2C_ECCR_MASK (0x1F) | |
| 97 | −#define I2C_ECCR_CC_MASK (0x1F) | |
| 98 | − | |
| 99 | −/* | |
| 100 | − * These events are more or less responses to commands | |
| 101 | − * sent into the hardware, presumably reflecting the state | |
| 102 | − * of an internal state machine. | |
| 103 | − */ | |
| 104 | −enum stu300_event { | |
| 105 | − STU300_EVENT_NONE = 0, | |
| 106 | − STU300_EVENT_1, | |
| 107 | − STU300_EVENT_2, | |
| 108 | − STU300_EVENT_3, | |
| 109 | − STU300_EVENT_4, | |
| 110 | − STU300_EVENT_5, | |
| 111 | − STU300_EVENT_6, | |
| 112 | − STU300_EVENT_7, | |
| 113 | − STU300_EVENT_8, | |
| 114 | − STU300_EVENT_9 | |
| 115 | −}; | |
| 116 | − | |
| 117 | −enum stu300_error { | |
| 118 | − STU300_ERROR_NONE = 0, | |
| 119 | − STU300_ERROR_ACKNOWLEDGE_FAILURE, | |
| 120 | − STU300_ERROR_BUS_ERROR, | |
| 121 | − STU300_ERROR_ARBITRATION_LOST, | |
| 122 | − STU300_ERROR_UNKNOWN | |
| 123 | −}; | |
| 124 | − | |
| 125 | −/* timeout waiting for the controller to respond */ | |
| 126 | −#define STU300_TIMEOUT (msecs_to_jiffies(1000)) | |
| 127 | − | |
| 128 | −/* | |
| 129 | − * The number of address send athemps tried before giving up. | |
| 130 | − * If the first one fails it seems like 5 to 8 attempts are required. | |
| 131 | − */ | |
| 132 | −#define NUM_ADDR_RESEND_ATTEMPTS 12 | |
| 133 | − | |
| 134 | −/* I2C clock speed, in Hz 0-400kHz*/ | |
| 135 | −static unsigned int scl_frequency = I2C_MAX_STANDARD_MODE_FREQ; | |
| 136 | −module_param(scl_frequency, uint, 0644); | |
| 137 | − | |
| 138 | −/** | |
| 139 | − * struct stu300_dev - the stu300 driver state holder | |
| 140 | − * @pdev: parent platform device | |
| 141 | − * @adapter: corresponding I2C adapter | |
| 142 | − * @clk: hardware block clock | |
| 143 | − * @irq: assigned interrupt line | |
| 144 | − * @cmd_issue_lock: this locks the following cmd_ variables | |
| 145 | − * @cmd_complete: acknowledge completion for an I2C command | |
| 146 | − * @cmd_event: expected event coming in as a response to a command | |
| 147 | − * @cmd_err: error code as response to a command | |
| 148 | − * @speed: current bus speed in Hz | |
| 149 | − * @msg_index: index of current message | |
| 150 | − * @msg_len: length of current message | |
| 151 | − */ | |
| 152 | − | |
| 153 | −struct stu300_dev { | |
| 154 | − struct platform_device *pdev; | |
| 155 | − struct i2c_adapter adapter; | |
| 156 | − void __iomem *virtbase; | |
| 157 | − struct clk *clk; | |
| 158 | − int irq; | |
| 159 | − spinlock_t cmd_issue_lock; | |
| 160 | − struct completion cmd_complete; | |
| 161 | − enum stu300_event cmd_event; | |
| 162 | − enum stu300_error cmd_err; | |
| 163 | − unsigned int speed; | |
| 164 | − int msg_index; | |
| 165 | − int msg_len; | |
| 166 | −}; | |
| 167 | − | |
| 168 | −/* Local forward function declarations */ | |
| 169 | −static int stu300_init_hw(struct stu300_dev *dev); | |
| 170 | − | |
| 171 | −/* | |
| 172 | − * The block needs writes in both MSW and LSW in order | |
| 173 | − * for all data lines to reach their destination. | |
| 174 | − */ | |
| 175 | −static inline void stu300_wr8(u32 value, void __iomem *address) | |
| 176 | −{ | |
| 177 | − writel((value << 16) | value, address); | |
| 178 | −} | |
| 179 | − | |
| 180 | −/* | |
| 181 | − * This merely masks off the duplicates which appear | |
| 182 | − * in bytes 1-3. You _MUST_ use 32-bit bus access on this | |
| 183 | − * device, else it will not work. | |
| 184 | − */ | |
| 185 | −static inline u32 stu300_r8(void __iomem *address) | |
| 186 | −{ | |
| 187 | − return readl(address) & 0x000000FFU; | |
| 188 | −} | |
| 189 | − | |
| 190 | −static void stu300_irq_enable(struct stu300_dev *dev) | |
| 191 | −{ | |
| 192 | − u32 val; | |
| 193 | − val = stu300_r8(dev->virtbase + I2C_CR); | |
| 194 | − val |= I2C_CR_INTERRUPT_ENABLE; | |
| 195 | − /* Twice paranoia (possible HW glitch) */ | |
| 196 | − stu300_wr8(val, dev->virtbase + I2C_CR); | |
| 197 | − stu300_wr8(val, dev->virtbase + I2C_CR); | |
| 198 | −} | |
| 199 | − | |
| 200 | −static void stu300_irq_disable(struct stu300_dev *dev) | |
| 201 | −{ | |
| 202 | − u32 val; | |
| 203 | − val = stu300_r8(dev->virtbase + I2C_CR); | |
| 204 | − val &= ~I2C_CR_INTERRUPT_ENABLE; | |
| 205 | − /* Twice paranoia (possible HW glitch) */ | |
| 206 | − stu300_wr8(val, dev->virtbase + I2C_CR); | |
| 207 | − stu300_wr8(val, dev->virtbase + I2C_CR); | |
| 208 | −} | |
| 209 | − | |
| 210 | − | |
| 211 | −/* | |
| 212 | − * Tells whether a certain event or events occurred in | |
| 213 | − * response to a command. The events represent states in | |
| 214 | − * the internal state machine of the hardware. The events | |
| 215 | − * are not very well described in the hardware | |
| 216 | − * documentation and can only be treated as abstract state | |
| 217 | − * machine states. | |
| 218 | − * | |
| 219 | − * @ret 0 = event has not occurred or unknown error, any | |
| 220 | − * other value means the correct event occurred or an error. | |
| 221 | − */ | |
| 222 | − | |
| 223 | −static int stu300_event_occurred(struct stu300_dev *dev, | |
| 224 | − enum stu300_event mr_event) { | |
| 225 | − u32 status1; | |
| 226 | − u32 status2; | |
| 227 | − | |
| 228 | − /* What event happened? */ | |
| 229 | − status1 = stu300_r8(dev->virtbase + I2C_SR1); | |
| 230 | − | |
| 231 | − if (!(status1 & I2C_SR1_EVF_IND)) | |
| 232 | − /* No event at all */ | |
| 233 | − return 0; | |
| 234 | − | |
| 235 | − status2 = stu300_r8(dev->virtbase + I2C_SR2); | |
| 236 | − | |
| 237 | − /* Block any multiple interrupts */ | |
| 238 | − stu300_irq_disable(dev); | |
| 239 | − | |
| 240 | − /* Check for errors first */ | |
| 241 | − if (status2 & I2C_SR2_AF_IND) { | |
| 242 | − dev->cmd_err = STU300_ERROR_ACKNOWLEDGE_FAILURE; | |
| 243 | − return 1; | |
| 244 | − } else if (status2 & I2C_SR2_BERR_IND) { | |
| 245 | − dev->cmd_err = STU300_ERROR_BUS_ERROR; | |
| 246 | − return 1; | |
| 247 | − } else if (status2 & I2C_SR2_ARLO_IND) { | |
| 248 | − dev->cmd_err = STU300_ERROR_ARBITRATION_LOST; | |
| 249 | − return 1; | |
| 250 | − } | |
| 251 | − | |
| 252 | − switch (mr_event) { | |
| 253 | − case STU300_EVENT_1: | |
| 254 | − if (status1 & I2C_SR1_ADSL_IND) | |
| 255 | − return 1; | |
| 256 | − break; | |
| 257 | − case STU300_EVENT_2: | |
| 258 | − case STU300_EVENT_3: | |
| 259 | − case STU300_EVENT_7: | |
| 260 | − case STU300_EVENT_8: | |
| 261 | − if (status1 & I2C_SR1_BTF_IND) { | |
| 262 | − return 1; | |
| 263 | − } | |
| 264 | − break; | |
| 265 | − case STU300_EVENT_4: | |
| 266 | − if (status2 & I2C_SR2_STOPF_IND) | |
| 267 | − return 1; | |
| 268 | − break; | |
| 269 | − case STU300_EVENT_5: | |
| 270 | − if (status1 & I2C_SR1_SB_IND) | |
| 271 | − /* Clear start bit */ | |
| 272 | − return 1; | |
| 273 | − break; | |
| 274 | − case STU300_EVENT_6: | |
| 275 | − if (status2 & I2C_SR2_ENDAD_IND) { | |
| 276 | − /* First check for any errors */ | |
| 277 | − return 1; | |
| 278 | − } | |
| 279 | − break; | |
| 280 | − case STU300_EVENT_9: | |
| 281 | − if (status1 & I2C_SR1_ADD10_IND) | |
| 282 | − return 1; | |
| 283 | − break; | |
| 284 | − default: | |
| 285 | − break; | |
| 286 | − } | |
| 287 | − /* If we get here, we're on thin ice. | |
| 288 | − * Here we are in a status where we have | |
| 289 | − * gotten a response that does not match | |
| 290 | − * what we requested. | |
| 291 | − */ | |
| 292 | − dev->cmd_err = STU300_ERROR_UNKNOWN; | |
| 293 | − dev_err(&dev->pdev->dev, | |
| 294 | − "Unhandled interrupt! %d sr1: 0x%x sr2: 0x%x\n", | |
| 295 | − mr_event, status1, status2); | |
| 296 | − return 0; | |
| 297 | −} | |
| 298 | − | |
| 299 | −static irqreturn_t stu300_irh(int irq, void *data) | |
| 300 | −{ | |
| 301 | − struct stu300_dev *dev = data; | |
| 302 | − int res; | |
| 303 | − | |
| 304 | − /* Just make sure that the block is clocked */ | |
| 305 | − clk_enable(dev->clk); | |
| 306 | − | |
| 307 | − /* See if this was what we were waiting for */ | |
| 308 | − spin_lock(&dev->cmd_issue_lock); | |
| 309 | − | |
| 310 | − res = stu300_event_occurred(dev, dev->cmd_event); | |
| 311 | − if (res || dev->cmd_err != STU300_ERROR_NONE) | |
| 312 | − complete(&dev->cmd_complete); | |
| 313 | − | |
| 314 | − spin_unlock(&dev->cmd_issue_lock); | |
| 315 | − | |
| 316 | − clk_disable(dev->clk); | |
| 317 | − | |
| 318 | − return IRQ_HANDLED; | |
| 319 | −} | |
| 320 | − | |
| 321 | −/* | |
| 322 | − * Sends a command and then waits for the bits masked by *flagmask* | |
| 323 | − * to go high or low by IRQ awaiting. | |
| 324 | − */ | |
| 325 | −static int stu300_start_and_await_event(struct stu300_dev *dev, | |
| 326 | − u8 cr_value, | |
| 327 | − enum stu300_event mr_event) | |
| 328 | −{ | |
| 329 | − int ret; | |
| 330 | − | |
| 331 | − /* Lock command issue, fill in an event we wait for */ | |
| 332 | − spin_lock_irq(&dev->cmd_issue_lock); | |
| 333 | − init_completion(&dev->cmd_complete); | |
| 334 | − dev->cmd_err = STU300_ERROR_NONE; | |
| 335 | − dev->cmd_event = mr_event; | |
| 336 | − spin_unlock_irq(&dev->cmd_issue_lock); | |
| 337 | − | |
| 338 | − /* Turn on interrupt, send command and wait. */ | |
| 339 | − cr_value |= I2C_CR_INTERRUPT_ENABLE; | |
| 340 | − stu300_wr8(cr_value, dev->virtbase + I2C_CR); | |
| 341 | − ret = wait_for_completion_interruptible_timeout(&dev->cmd_complete, | |
| 342 | − STU300_TIMEOUT); | |
| 343 | − if (ret < 0) { | |
| 344 | − dev_err(&dev->pdev->dev, | |
| 345 | − "wait_for_completion_interruptible_timeout() " | |
| 346 | − "returned %d waiting for event %04x\n", ret, mr_event); | |
| 347 | − return ret; | |
| 348 | − } | |
| 349 | − | |
| 350 | − if (ret == 0) { | |
| 351 | − dev_err(&dev->pdev->dev, "controller timed out " | |
| 352 | − "waiting for event %d, reinit hardware\n", mr_event); | |
| 353 | − (void) stu300_init_hw(dev); | |
| 354 | − return -ETIMEDOUT; | |
| 355 | − } | |
| 356 | − | |
| 357 | − if (dev->cmd_err != STU300_ERROR_NONE) { | |
| 358 | − dev_err(&dev->pdev->dev, "controller (start) " | |
| 359 | − "error %d waiting for event %d, reinit hardware\n", | |
| 360 | − dev->cmd_err, mr_event); | |
| 361 | − (void) stu300_init_hw(dev); | |
| 362 | − return -EIO; | |
| 363 | − } | |
| 364 | − | |
| 365 | − return 0; | |
| 366 | −} | |
| 367 | − | |
| 368 | −/* | |
| 369 | − * This waits for a flag to be set, if it is not set on entry, an interrupt is | |
| 370 | − * configured to wait for the flag using a completion. | |
| 371 | − */ | |
| 372 | −static int stu300_await_event(struct stu300_dev *dev, | |
| 373 | − enum stu300_event mr_event) | |
| 374 | −{ | |
| 375 | − int ret; | |
| 376 | − | |
| 377 | − /* Is it already here? */ | |
| 378 | − spin_lock_irq(&dev->cmd_issue_lock); | |
| 379 | − dev->cmd_err = STU300_ERROR_NONE; | |
| 380 | − dev->cmd_event = mr_event; | |
| 381 | − | |
| 382 | − init_completion(&dev->cmd_complete); | |
| 383 | − | |
| 384 | − /* Turn on the I2C interrupt for current operation */ | |
| 385 | − stu300_irq_enable(dev); | |
| 386 | − | |
| 387 | − /* Unlock the command block and wait for the event to occur */ | |
| 388 | − spin_unlock_irq(&dev->cmd_issue_lock); | |
| 389 | − | |
| 390 | − ret = wait_for_completion_interruptible_timeout(&dev->cmd_complete, | |
| 391 | − STU300_TIMEOUT); | |
| 392 | − if (ret < 0) { | |
| 393 | − dev_err(&dev->pdev->dev, | |
| 394 | − "wait_for_completion_interruptible_timeout()" | |
| 395 | − "returned %d waiting for event %04x\n", ret, mr_event); | |
| 396 | − return ret; | |
| 397 | − } | |
| 398 | − | |
| 399 | − if (ret == 0) { | |
| 400 | − if (mr_event != STU300_EVENT_6) { | |
| 401 | − dev_err(&dev->pdev->dev, "controller " | |
| 402 | − "timed out waiting for event %d, reinit " | |
| 403 | − "hardware\n", mr_event); | |
| 404 | − (void) stu300_init_hw(dev); | |
| 405 | − } | |
| 406 | − return -ETIMEDOUT; | |
| 407 | − } | |
| 408 | − | |
| 409 | − if (dev->cmd_err != STU300_ERROR_NONE) { | |
| 410 | − if (mr_event != STU300_EVENT_6) { | |
| 411 | − dev_err(&dev->pdev->dev, "controller " | |
| 412 | − "error (await_event) %d waiting for event %d, " | |
| 413 | − "reinit hardware\n", dev->cmd_err, mr_event); | |
| 414 | − (void) stu300_init_hw(dev); | |
| 415 | − } | |
| 416 | − return -EIO; | |
| 417 | − } | |
| 418 | − | |
| 419 | − return 0; | |
| 420 | −} | |
| 421 | − | |
| 422 | −/* | |
| 423 | − * Waits for the busy bit to go low by repeated polling. | |
| 424 | − */ | |
| 425 | −#define BUSY_RELEASE_ATTEMPTS 10 | |
| 426 | −static int stu300_wait_while_busy(struct stu300_dev *dev) | |
| 427 | −{ | |
| 428 | − unsigned long timeout; | |
| 429 | − int i; | |
| 430 | − | |
| 431 | − for (i = 0; i < BUSY_RELEASE_ATTEMPTS; i++) { | |
| 432 | − timeout = jiffies + STU300_TIMEOUT; | |
| 433 | − | |
| 434 | − while (!time_after(jiffies, timeout)) { | |
| 435 | − /* Is not busy? */ | |
| 436 | − if ((stu300_r8(dev->virtbase + I2C_SR1) & | |
| 437 | − I2C_SR1_BUSY_IND) == 0) | |
| 438 | − return 0; | |
| 439 | − msleep(1); | |
| 440 | − } | |
| 441 | − | |
| 442 | − dev_err(&dev->pdev->dev, "transaction timed out " | |
| 443 | − "waiting for device to be free (not busy). " | |
| 444 | − "Attempt: %d\n", i+1); | |
| 445 | − | |
| 446 | − dev_err(&dev->pdev->dev, "base address = " | |
| 447 | − "0x%p, reinit hardware\n", dev->virtbase); | |
| 448 | − | |
| 449 | − (void) stu300_init_hw(dev); | |
| 450 | − } | |
| 451 | − | |
| 452 | − dev_err(&dev->pdev->dev, "giving up after %d attempts " | |
| 453 | − "to reset the bus.\n", BUSY_RELEASE_ATTEMPTS); | |
| 454 | − | |
| 455 | − return -ETIMEDOUT; | |
| 456 | −} | |
| 457 | − | |
| 458 | −struct stu300_clkset { | |
| 459 | − unsigned long rate; | |
| 460 | − u32 setting; | |
| 461 | −}; | |
| 462 | − | |
| 463 | −static const struct stu300_clkset stu300_clktable[] = { | |
| 464 | − { 0, 0xFFU }, | |
| 465 | − { 2500000, I2C_OAR2_FR_25_10MHZ }, | |
| 466 | − { 10000000, I2C_OAR2_FR_10_1667MHZ }, | |
| 467 | − { 16670000, I2C_OAR2_FR_1667_2667MHZ }, | |
| 468 | − { 26670000, I2C_OAR2_FR_2667_40MHZ }, | |
| 469 | − { 40000000, I2C_OAR2_FR_40_5333MHZ }, | |
| 470 | − { 53330000, I2C_OAR2_FR_5333_66MHZ }, | |
| 471 | − { 66000000, I2C_OAR2_FR_66_80MHZ }, | |
| 472 | − { 80000000, I2C_OAR2_FR_80_100MHZ }, | |
| 473 | − { 100000000, 0xFFU }, | |
| 474 | −}; | |
| 475 | − | |
| 476 | − | |
| 477 | −static int stu300_set_clk(struct stu300_dev *dev, unsigned long clkrate) | |
| 478 | −{ | |
| 479 | − | |
| 480 | − u32 val; | |
| 481 | − int i = 0; | |
| 482 | − | |
| 483 | − /* Locate the appropriate clock setting */ | |
| 484 | − while (i < ARRAY_SIZE(stu300_clktable) - 1 && | |
| 485 | − stu300_clktable[i].rate < clkrate) | |
| 486 | − i++; | |
| 487 | − | |
| 488 | − if (stu300_clktable[i].setting == 0xFFU) { | |
| 489 | − dev_err(&dev->pdev->dev, "too %s clock rate requested " | |
| 490 | − "(%lu Hz).\n", i ? "high" : "low", clkrate); | |
| 491 | − return -EINVAL; | |
| 492 | − } | |
| 493 | − | |
| 494 | − stu300_wr8(stu300_clktable[i].setting, | |
| 495 | − dev->virtbase + I2C_OAR2); | |
| 496 | − | |
| 497 | − dev_dbg(&dev->pdev->dev, "Clock rate %lu Hz, I2C bus speed %d Hz " | |
| 498 | − "virtbase %p\n", clkrate, dev->speed, dev->virtbase); | |
| 499 | − | |
| 500 | − if (dev->speed > I2C_MAX_STANDARD_MODE_FREQ) | |
| 501 | − /* Fast Mode I2C */ | |
| 502 | − val = ((clkrate/dev->speed) - 9)/3 + 1; | |
| 503 | − else | |
| 504 | − /* Standard Mode I2C */ | |
| 505 | − val = ((clkrate/dev->speed) - 7)/2 + 1; | |
| 506 | − | |
| 507 | − /* According to spec the divider must be > 2 */ | |
| 508 | − if (val < 0x002) { | |
| 509 | − dev_err(&dev->pdev->dev, "too low clock rate (%lu Hz).\n", | |
| 510 | − clkrate); | |
| 511 | − return -EINVAL; | |
| 512 | − } | |
| 513 | − | |
| 514 | − /* We have 12 bits clock divider only! */ | |
| 515 | − if (val & 0xFFFFF000U) { | |
| 516 | − dev_err(&dev->pdev->dev, "too high clock rate (%lu Hz).\n", | |
| 517 | − clkrate); | |
| 518 | − return -EINVAL; | |
| 519 | − } | |
| 520 | − | |
| 521 | − if (dev->speed > I2C_MAX_STANDARD_MODE_FREQ) { | |
| 522 | − /* CC6..CC0 */ | |
| 523 | − stu300_wr8((val & I2C_CCR_CC_MASK) | I2C_CCR_FMSM, | |
| 524 | − dev->virtbase + I2C_CCR); | |
| 525 | − dev_dbg(&dev->pdev->dev, "set clock divider to 0x%08x, " | |
| 526 | − "Fast Mode I2C\n", val); | |
| 527 | − } else { | |
| 528 | − /* CC6..CC0 */ | |
| 529 | − stu300_wr8((val & I2C_CCR_CC_MASK), | |
| 530 | − dev->virtbase + I2C_CCR); | |
| 531 | − dev_dbg(&dev->pdev->dev, "set clock divider to " | |
| 532 | − "0x%08x, Standard Mode I2C\n", val); | |
| 533 | − } | |
| 534 | − | |
| 535 | − /* CC11..CC7 */ | |
| 536 | − stu300_wr8(((val >> 7) & 0x1F), | |
| 537 | − dev->virtbase + I2C_ECCR); | |
| 538 | − | |
| 539 | − return 0; | |
| 540 | −} | |
| 541 | − | |
| 542 | − | |
| 543 | −static int stu300_init_hw(struct stu300_dev *dev) | |
| 544 | −{ | |
| 545 | − u32 dummy; | |
| 546 | − unsigned long clkrate; | |
| 547 | − int ret; | |
| 548 | − | |
| 549 | − /* Disable controller */ | |
| 550 | − stu300_wr8(0x00, dev->virtbase + I2C_CR); | |
| 551 | − /* | |
| 552 | − * Set own address to some default value (0x00). | |
| 553 | − * We do not support slave mode anyway. | |
| 554 | − */ | |
| 555 | − stu300_wr8(0x00, dev->virtbase + I2C_OAR1); | |
| 556 | − /* | |
| 557 | − * The I2C controller only operates properly in 26 MHz but we | |
| 558 | − * program this driver as if we didn't know. This will also set the two | |
| 559 | − * high bits of the own address to zero as well. | |
| 560 | − * There is no known hardware issue with running in 13 MHz | |
| 561 | − * However, speeds over 200 kHz are not used. | |
| 562 | − */ | |
| 563 | − clkrate = clk_get_rate(dev->clk); | |
| 564 | − ret = stu300_set_clk(dev, clkrate); | |
| 565 | − | |
| 566 | − if (ret) | |
| 567 | − return ret; | |
| 568 | − /* | |
| 569 | − * Enable block, do it TWICE (hardware glitch) | |
| 570 | − * Setting bit 7 can enable DDC mode. (Not used currently.) | |
| 571 | − */ | |
| 572 | − stu300_wr8(I2C_CR_PERIPHERAL_ENABLE, | |
| 573 | − dev->virtbase + I2C_CR); | |
| 574 | − stu300_wr8(I2C_CR_PERIPHERAL_ENABLE, | |
| 575 | − dev->virtbase + I2C_CR); | |
| 576 | − /* Make a dummy read of the status register SR1 & SR2 */ | |
| 577 | − dummy = stu300_r8(dev->virtbase + I2C_SR2); | |
| 578 | − dummy = stu300_r8(dev->virtbase + I2C_SR1); | |
| 579 | − | |
| 580 | − return 0; | |
| 581 | −} | |
| 582 | − | |
| 583 | − | |
| 584 | − | |
| 585 | −/* Send slave address. */ | |
| 586 | −static int stu300_send_address(struct stu300_dev *dev, | |
| 587 | − struct i2c_msg *msg, int resend) | |
| 588 | −{ | |
| 589 | − u32 val; | |
| 590 | − int ret; | |
| 591 | − | |
| 592 | − if (msg->flags & I2C_M_TEN) { | |
| 593 | − /* This is probably how 10 bit addresses look */ | |
| 594 | − val = (0xf0 | (((u32) msg->addr & 0x300) >> 7)) & | |
| 595 | − I2C_DR_D_MASK; | |
| 596 | − if (msg->flags & I2C_M_RD) | |
| 597 | − /* This is the direction bit */ | |
| 598 | − val |= 0x01; | |
| 599 | − } else { | |
| 600 | − val = i2c_8bit_addr_from_msg(msg); | |
| 601 | − } | |
| 602 | − | |
| 603 | − if (resend) { | |
| 604 | − if (msg->flags & I2C_M_RD) | |
| 605 | − dev_dbg(&dev->pdev->dev, "read resend\n"); | |
| 606 | − else | |
| 607 | − dev_dbg(&dev->pdev->dev, "write resend\n"); | |
| 608 | − } | |
| 609 | − | |
| 610 | − stu300_wr8(val, dev->virtbase + I2C_DR); | |
| 611 | − | |
| 612 | − /* For 10bit addressing, await 10bit request (EVENT 9) */ | |
| 613 | − if (msg->flags & I2C_M_TEN) { | |
| 614 | − ret = stu300_await_event(dev, STU300_EVENT_9); | |
| 615 | − /* | |
| 616 | − * The slave device wants a 10bit address, send the rest | |
| 617 | − * of the bits (the LSBits) | |
| 618 | − */ | |
| 619 | − val = msg->addr & I2C_DR_D_MASK; | |
| 620 | − /* This clears "event 9" */ | |
| 621 | − stu300_wr8(val, dev->virtbase + I2C_DR); | |
| 622 | − if (ret != 0) | |
| 623 | − return ret; | |
| 624 | − } | |
| 625 | − /* FIXME: Why no else here? two events for 10bit? | |
| 626 | − * Await event 6 (normal) or event 9 (10bit) | |
| 627 | − */ | |
| 628 | − | |
| 629 | − if (resend) | |
| 630 | − dev_dbg(&dev->pdev->dev, "await event 6\n"); | |
| 631 | − ret = stu300_await_event(dev, STU300_EVENT_6); | |
| 632 | − | |
| 633 | − /* | |
| 634 | − * Clear any pending EVENT 6 no matter what happened during | |
| 635 | − * await_event. | |
| 636 | − */ | |
| 637 | − val = stu300_r8(dev->virtbase + I2C_CR); | |
| 638 | − val |= I2C_CR_PERIPHERAL_ENABLE; | |
| 639 | − stu300_wr8(val, dev->virtbase + I2C_CR); | |
| 640 | − | |
| 641 | − return ret; | |
| 642 | −} | |
| 643 | − | |
| 644 | −static int stu300_xfer_msg(struct i2c_adapter *adap, | |
| 645 | − struct i2c_msg *msg, int stop) | |
| 646 | −{ | |
| 647 | − u32 cr; | |
| 648 | − u32 val; | |
| 649 | − u32 i; | |
| 650 | − int ret; | |
| 651 | − int attempts = 0; | |
| 652 | − struct stu300_dev *dev = i2c_get_adapdata(adap); | |
| 653 | − | |
| 654 | − clk_enable(dev->clk); | |
| 655 | − | |
| 656 | − /* Remove this if (0) to trace each and every message. */ | |
| 657 | − if (0) { | |
| 658 | − dev_dbg(&dev->pdev->dev, "I2C message to: 0x%04x, len: %d, " | |
| 659 | − "flags: 0x%04x, stop: %d\n", | |
| 660 | − msg->addr, msg->len, msg->flags, stop); | |
| 661 | − } | |
| 662 | − | |
| 663 | − /* | |
| 664 | − * For some reason, sending the address sometimes fails when running | |
| 665 | − * on the 13 MHz clock. No interrupt arrives. This is a work around, | |
| 666 | − * which tries to restart and send the address up to 10 times before | |
| 667 | − * really giving up. Usually 5 to 8 attempts are enough. | |
| 668 | − */ | |
| 669 | − do { | |
| 670 | − if (attempts) | |
| 671 | − dev_dbg(&dev->pdev->dev, "wait while busy\n"); | |
| 672 | − /* Check that the bus is free, or wait until some timeout */ | |
| 673 | − ret = stu300_wait_while_busy(dev); | |
| 674 | − if (ret != 0) | |
| 675 | − goto exit_disable; | |
| 676 | − | |
| 677 | − if (attempts) | |
| 678 | − dev_dbg(&dev->pdev->dev, "re-int hw\n"); | |
| 679 | − /* | |
| 680 | − * According to ST, there is no problem if the clock is | |
| 681 | − * changed between 13 and 26 MHz during a transfer. | |
| 682 | − */ | |
| 683 | − ret = stu300_init_hw(dev); | |
| 684 | − if (ret) | |
| 685 | − goto exit_disable; | |
| 686 | − | |
| 687 | − /* Send a start condition */ | |
| 688 | − cr = I2C_CR_PERIPHERAL_ENABLE; | |
| 689 | − /* Setting the START bit puts the block in master mode */ | |
| 690 | − if (!(msg->flags & I2C_M_NOSTART)) | |
| 691 | − cr |= I2C_CR_START_ENABLE; | |
| 692 | − if ((msg->flags & I2C_M_RD) && (msg->len > 1)) | |
| 693 | − /* On read more than 1 byte, we need ack. */ | |
| 694 | − cr |= I2C_CR_ACK_ENABLE; | |
| 695 | − /* Check that it gets through */ | |
| 696 | − if (!(msg->flags & I2C_M_NOSTART)) { | |
| 697 | − if (attempts) | |
| 698 | − dev_dbg(&dev->pdev->dev, "send start event\n"); | |
| 699 | − ret = stu300_start_and_await_event(dev, cr, | |
| 700 | − STU300_EVENT_5); | |
| 701 | − } | |
| 702 | − | |
| 703 | − if (attempts) | |
| 704 | − dev_dbg(&dev->pdev->dev, "send address\n"); | |
| 705 | − | |
| 706 | − if (ret == 0) | |
| 707 | − /* Send address */ | |
| 708 | − ret = stu300_send_address(dev, msg, attempts != 0); | |
| 709 | − | |
| 710 | − if (ret != 0) { | |
| 711 | − attempts++; | |
| 712 | − dev_dbg(&dev->pdev->dev, "failed sending address, " | |
| 713 | − "retrying. Attempt: %d msg_index: %d/%d\n", | |
| 714 | − attempts, dev->msg_index, dev->msg_len); | |
| 715 | − } | |
| 716 | − | |
| 717 | − } while (ret != 0 && attempts < NUM_ADDR_RESEND_ATTEMPTS); | |
| 718 | − | |
| 719 | − if (attempts < NUM_ADDR_RESEND_ATTEMPTS && attempts > 0) { | |
| 720 | − dev_dbg(&dev->pdev->dev, "managed to get address " | |
| 721 | − "through after %d attempts\n", attempts); | |
| 722 | − } else if (attempts == NUM_ADDR_RESEND_ATTEMPTS) { | |
| 723 | − dev_dbg(&dev->pdev->dev, "I give up, tried %d times " | |
| 724 | − "to resend address.\n", | |
| 725 | − NUM_ADDR_RESEND_ATTEMPTS); | |
| 726 | − goto exit_disable; | |
| 727 | − } | |
| 728 | − | |
| 729 | − | |
| 730 | − if (msg->flags & I2C_M_RD) { | |
| 731 | − /* READ: we read the actual bytes one at a time */ | |
| 732 | − for (i = 0; i < msg->len; i++) { | |
| 733 | − if (i == msg->len-1) { | |
| 734 | − /* | |
| 735 | − * Disable ACK and set STOP condition before | |
| 736 | − * reading last byte | |
| 737 | − */ | |
| 738 | − val = I2C_CR_PERIPHERAL_ENABLE; | |
| 739 | − | |
| 740 | − if (stop) | |
| 741 | − val |= I2C_CR_STOP_ENABLE; | |
| 742 | − | |
| 743 | − stu300_wr8(val, | |
| 744 | − dev->virtbase + I2C_CR); | |
| 745 | − } | |
| 746 | − /* Wait for this byte... */ | |
| 747 | − ret = stu300_await_event(dev, STU300_EVENT_7); | |
| 748 | − if (ret != 0) | |
| 749 | − goto exit_disable; | |
| 750 | − /* This clears event 7 */ | |
| 751 | − msg->buf[i] = (u8) stu300_r8(dev->virtbase + I2C_DR); | |
| 752 | − } | |
| 753 | − } else { | |
| 754 | − /* WRITE: we send the actual bytes one at a time */ | |
| 755 | − for (i = 0; i < msg->len; i++) { | |
| 756 | − /* Write the byte */ | |
| 757 | − stu300_wr8(msg->buf[i], | |
| 758 | − dev->virtbase + I2C_DR); | |
| 759 | − /* Check status */ | |
| 760 | − ret = stu300_await_event(dev, STU300_EVENT_8); | |
| 761 | − /* Next write to DR will clear event 8 */ | |
| 762 | − if (ret != 0) { | |
| 763 | − dev_err(&dev->pdev->dev, "error awaiting " | |
| 764 | − "event 8 (%d)\n", ret); | |
| 765 | − goto exit_disable; | |
| 766 | − } | |
| 767 | − } | |
| 768 | − /* Check NAK */ | |
| 769 | − if (!(msg->flags & I2C_M_IGNORE_NAK)) { | |
| 770 | − if (stu300_r8(dev->virtbase + I2C_SR2) & | |
| 771 | − I2C_SR2_AF_IND) { | |
| 772 | − dev_err(&dev->pdev->dev, "I2C payload " | |
| 773 | − "send returned NAK!\n"); | |
| 774 | − ret = -EIO; | |
| 775 | − goto exit_disable; | |
| 776 | − } | |
| 777 | − } | |
| 778 | − if (stop) { | |
| 779 | − /* Send stop condition */ | |
| 780 | − val = I2C_CR_PERIPHERAL_ENABLE; | |
| 781 | − val |= I2C_CR_STOP_ENABLE; | |
| 782 | − stu300_wr8(val, dev->virtbase + I2C_CR); | |
| 783 | − } | |
| 784 | − } | |
| 785 | − | |
| 786 | − /* Check that the bus is free, or wait until some timeout occurs */ | |
| 787 | − ret = stu300_wait_while_busy(dev); | |
| 788 | − if (ret != 0) { | |
| 789 | − dev_err(&dev->pdev->dev, "timeout waiting for transfer " | |
| 790 | − "to commence.\n"); | |
| 791 | − goto exit_disable; | |
| 792 | − } | |
| 793 | − | |
| 794 | − /* Dummy read status registers */ | |
| 795 | − val = stu300_r8(dev->virtbase + I2C_SR2); | |
| 796 | − val = stu300_r8(dev->virtbase + I2C_SR1); | |
| 797 | − ret = 0; | |
| 798 | − | |
| 799 | − exit_disable: | |
| 800 | − /* Disable controller */ | |
| 801 | − stu300_wr8(0x00, dev->virtbase + I2C_CR); | |
| 802 | − clk_disable(dev->clk); | |
| 803 | − return ret; | |
| 804 | −} | |
| 805 | − | |
| 806 | −static int stu300_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs, | |
| 807 | − int num) | |
| 808 | −{ | |
| 809 | − int ret = -1; | |
| 810 | − int i; | |
| 811 | − | |
| 812 | − struct stu300_dev *dev = i2c_get_adapdata(adap); | |
| 813 | − dev->msg_len = num; | |
| 814 | − | |
| 815 | − for (i = 0; i < num; i++) { | |
| 816 | − /* | |
| 817 | − * Another driver appears to send stop for each message, | |
| 818 | − * here we only do that for the last message. Possibly some | |
| 819 | − * peripherals require this behaviour, then their drivers | |
| 820 | − * have to send single messages in order to get "stop" for | |
| 821 | − * each message. | |
| 822 | − */ | |
| 823 | − dev->msg_index = i; | |
| 824 | − | |
| 825 | − ret = stu300_xfer_msg(adap, &msgs[i], (i == (num - 1))); | |
| 826 | − | |
| 827 | − if (ret != 0) { | |
| 828 | − num = ret; | |
| 829 | − break; | |
| 830 | − } | |
| 831 | − } | |
| 832 | − | |
| 833 | − return num; | |
| 834 | −} | |
| 835 | − | |
| 836 | −static int stu300_xfer_todo(struct i2c_adapter *adap, struct i2c_msg *msgs, int num) | |
| 837 | −{ | |
| 838 | − /* TODO: implement polling for this case if need be. */ | |
| 839 | − WARN(1, "%s: atomic transfers not implemented\n", dev_name(&adap->dev)); | |
| 840 | − return -EOPNOTSUPP; | |
| 841 | −} | |
| 842 | − | |
| 843 | −static u32 stu300_func(struct i2c_adapter *adap) | |
| 844 | −{ | |
| 845 | − /* This is the simplest thing you can think of... */ | |
| 846 | − return I2C_FUNC_I2C | I2C_FUNC_10BIT_ADDR; | |
| 847 | −} | |
| 848 | − | |
| 849 | −static const struct i2c_algorithm stu300_algo = { | |
| 850 | − .master_xfer = stu300_xfer, | |
| 851 | − .master_xfer_atomic = stu300_xfer_todo, | |
| 852 | − .functionality = stu300_func, | |
| 853 | −}; | |
| 854 | − | |
| 855 | −static const struct i2c_adapter_quirks stu300_quirks = { | |
| 856 | − .flags = I2C_AQ_NO_ZERO_LEN, | |
| 857 | −}; | |
| 858 | − | |
| 859 | −static int stu300_probe(struct platform_device *pdev) | |
| 860 | −{ | |
| 861 | − struct stu300_dev *dev; | |
| 862 | − struct i2c_adapter *adap; | |
| 863 | − int bus_nr; | |
| 864 | − int ret = 0; | |
| 865 | − | |
| 866 | − dev = devm_kzalloc(&pdev->dev, sizeof(struct stu300_dev), GFP_KERNEL); | |
| 867 | − if (!dev) | |
| 868 | − return -ENOMEM; | |
| 869 | − | |
| 870 | − bus_nr = pdev->id; | |
| 871 | − dev->clk = devm_clk_get(&pdev->dev, NULL); | |
| 872 | − if (IS_ERR(dev->clk)) { | |
| 873 | − dev_err(&pdev->dev, "could not retrieve i2c bus clock\n"); | |
| 874 | − return PTR_ERR(dev->clk); | |
| 875 | − } | |
| 876 | − | |
| 877 | − dev->pdev = pdev; | |
| 878 | − dev->virtbase = devm_platform_ioremap_resource(pdev, 0); | |
| 879 | − dev_dbg(&pdev->dev, "initialize bus device I2C%d on virtual " | |
| 880 | − "base %p\n", bus_nr, dev->virtbase); | |
| 881 | − if (IS_ERR(dev->virtbase)) | |
| 882 | − return PTR_ERR(dev->virtbase); | |
| 883 | − | |
| 884 | − dev->irq = platform_get_irq(pdev, 0); | |
| 885 | − ret = devm_request_irq(&pdev->dev, dev->irq, stu300_irh, 0, NAME, dev); | |
| 886 | − if (ret < 0) | |
| 887 | − return ret; | |
| 888 | − | |
| 889 | − dev->speed = scl_frequency; | |
| 890 | − | |
| 891 | − clk_prepare_enable(dev->clk); | |
| 892 | − ret = stu300_init_hw(dev); | |
| 893 | − clk_disable(dev->clk); | |
| 894 | − if (ret != 0) { | |
| 895 | − dev_err(&dev->pdev->dev, "error initializing hardware.\n"); | |
| 896 | − return -EIO; | |
| 897 | − } | |
| 898 | − | |
| 899 | − /* IRQ event handling initialization */ | |
| 900 | − spin_lock_init(&dev->cmd_issue_lock); | |
| 901 | − dev->cmd_event = STU300_EVENT_NONE; | |
| 902 | − dev->cmd_err = STU300_ERROR_NONE; | |
| 903 | − | |
| 904 | − adap = &dev->adapter; | |
| 905 | − adap->owner = THIS_MODULE; | |
| 906 | − /* DDC class but actually often used for more generic I2C */ | |
| 907 | − adap->class = I2C_CLASS_DEPRECATED; | |
| 908 | − strlcpy(adap->name, "ST Microelectronics DDC I2C adapter", | |
| 909 | − sizeof(adap->name)); | |
| 910 | − adap->nr = bus_nr; | |
| 911 | − adap->algo = &stu300_algo; | |
| 912 | − adap->dev.parent = &pdev->dev; | |
| 913 | − adap->dev.of_node = pdev->dev.of_node; | |
| 914 | − adap->quirks = &stu300_quirks; | |
| 915 | − | |
| 916 | − i2c_set_adapdata(adap, dev); | |
| 917 | − | |
| 918 | − /* i2c device drivers may be active on return from add_adapter() */ | |
| 919 | − ret = i2c_add_numbered_adapter(adap); | |
| 920 | − if (ret) | |
| 921 | − return ret; | |
| 922 | − | |
| 923 | − platform_set_drvdata(pdev, dev); | |
| 924 | − dev_info(&pdev->dev, "ST DDC I2C @ %p, irq %d\n", | |
| 925 | − dev->virtbase, dev->irq); | |
| 926 | − | |
| 927 | − return 0; | |
| 928 | −} | |
| 929 | − | |
| 930 | −#ifdef CONFIG_PM_SLEEP | |
| 931 | −static int stu300_suspend(struct device *device) | |
| 932 | −{ | |
| 933 | − struct stu300_dev *dev = dev_get_drvdata(device); | |
| 934 | − | |
| 935 | − /* Turn off everything */ | |
| 936 | − stu300_wr8(0x00, dev->virtbase + I2C_CR); | |
| 937 | − return 0; | |
| 938 | −} | |
| 939 | − | |
| 940 | −static int stu300_resume(struct device *device) | |
| 941 | −{ | |
| 942 | − int ret = 0; | |
| 943 | − struct stu300_dev *dev = dev_get_drvdata(device); | |
| 944 | − | |
| 945 | − clk_enable(dev->clk); | |
| 946 | − ret = stu300_init_hw(dev); | |
| 947 | − clk_disable(dev->clk); | |
| 948 | − | |
| 949 | − if (ret != 0) | |
| 950 | − dev_err(device, "error re-initializing hardware.\n"); | |
| 951 | − return ret; | |
| 952 | −} | |
| 953 | − | |
| 954 | −static SIMPLE_DEV_PM_OPS(stu300_pm, stu300_suspend, stu300_resume); | |
| 955 | −#define STU300_I2C_PM (&stu300_pm) | |
| 956 | −#else | |
| 957 | −#define STU300_I2C_PM NULL | |
| 958 | −#endif | |
| 959 | − | |
| 960 | −static int stu300_remove(struct platform_device *pdev) | |
| 961 | −{ | |
| 962 | − struct stu300_dev *dev = platform_get_drvdata(pdev); | |
| 963 | − | |
| 964 | − i2c_del_adapter(&dev->adapter); | |
| 965 | − /* Turn off everything */ | |
| 966 | − stu300_wr8(0x00, dev->virtbase + I2C_CR); | |
| 967 | − return 0; | |
| 968 | −} | |
| 969 | − | |
| 970 | −static const struct of_device_id stu300_dt_match[] = { | |
| 971 | − { .compatible = "st,ddci2c" }, | |
| 972 | − {}, | |
| 973 | −}; | |
| 974 | −MODULE_DEVICE_TABLE(of, stu300_dt_match); | |
| 975 | − | |
| 976 | −static struct platform_driver stu300_i2c_driver = { | |
| 977 | − .driver = { | |
| 978 | − .name = NAME, | |
| 979 | − .pm = STU300_I2C_PM, | |
| 980 | − .of_match_table = stu300_dt_match, | |
| 981 | − }, | |
| 982 | − .probe = stu300_probe, | |
| 983 | − .remove = stu300_remove, | |
| 984 | − | |
| 985 | −}; | |
| 986 | − | |
| 987 | −static int __init stu300_init(void) | |
| 988 | −{ | |
| 989 | − return platform_driver_register(&stu300_i2c_driver); | |
| 990 | −} | |
| 991 | − | |
| 992 | −static void __exit stu300_exit(void) | |
| 993 | −{ | |
| 994 | − platform_driver_unregister(&stu300_i2c_driver); | |
| 995 | −} | |
| 996 | − | |
| 997 | −/* | |
| 998 | − * The systems using this bus often have very basic devices such | |
| 999 | − * as regulators on the I2C bus, so this needs to be loaded early. | |
| 1000 | − * Therefore it is registered in the subsys_initcall(). | |
| 1001 | − */ | |
| 1002 | −subsys_initcall(stu300_init); | |
| 1003 | −module_exit(stu300_exit); | |
| 1004 | − | |
| 1005 | −MODULE_AUTHOR("Linus Walleij <linus.walleij@stericsson.com>"); | |
| 1006 | −MODULE_DESCRIPTION("ST Micro DDC I2C adapter (" NAME ")"); | |
| 1007 | −MODULE_LICENSE("GPL"); | |
| 1008 | −MODULE_ALIAS("platform:" NAME); | |
| @@ -550,7 +550,7 @@ static int tegra_i2c_poll_register(struct tegra_i2c_dev *i2c_dev, · 549 unmodified lines | ||
| 550 | 550 | void __iomem *addr = i2c_dev->base + tegra_i2c_reg_addr(i2c_dev, reg); |
| 551 | 551 | u32 val; |
| 552 | 552 | |
| 553 | − if (!i2c_dev->atomic_mode && !in_irq()) | |
| 553 | + if (!i2c_dev->atomic_mode) | |
| 554 | 554 | return readl_relaxed_poll_timeout(addr, val, !(val & mask), |
| 555 | 555 | delay_us, timeout_us); |
| 556 | 556 | |
| @@ -1739,9 +1739,10 @@ static int tegra_i2c_probe(struct platform_device *pdev) · 1182 unmodified lines | ||
| 1739 | 1739 | /* interrupt will be enabled during of transfer time */ |
| 1740 | 1740 | irq_set_status_flags(i2c_dev->irq, IRQ_NOAUTOEN); |
| 1741 | 1741 | |
| 1742 | − err = devm_request_irq(i2c_dev->dev, i2c_dev->irq, tegra_i2c_isr, | |
| 1743 | − IRQF_NO_SUSPEND, dev_name(i2c_dev->dev), | |
| 1744 | − i2c_dev); | |
| 1742 | + err = devm_request_threaded_irq(i2c_dev->dev, i2c_dev->irq, | |
| 1743 | + NULL, tegra_i2c_isr, | |
| 1744 | + IRQF_NO_SUSPEND | IRQF_ONESHOT, | |
| 1745 | + dev_name(i2c_dev->dev), i2c_dev); | |
| 1745 | 1746 | if (err) |
| 1746 | 1747 | return err; |
| 1747 | 1748 | |
| @@ -1,602 +0,0 @@ | ||
| 1 | −// SPDX-License-Identifier: GPL-2.0-only | |
| 2 | −/* | |
| 3 | − * Copyright (C) 2017 Sanechips Technology Co., Ltd. | |
| 4 | − * Copyright 2017 Linaro Ltd. | |
| 5 | − * | |
| 6 | − * Author: Baoyou Xie <baoyou.xie@linaro.org> | |
| 7 | − */ | |
| 8 | − | |
| 9 | −#include <linux/clk.h> | |
| 10 | −#include <linux/i2c.h> | |
| 11 | −#include <linux/interrupt.h> | |
| 12 | −#include <linux/io.h> | |
| 13 | −#include <linux/module.h> | |
| 14 | −#include <linux/platform_device.h> | |
| 15 | − | |
| 16 | −#define REG_CMD 0x04 | |
| 17 | −#define REG_DEVADDR_H 0x0C | |
| 18 | −#define REG_DEVADDR_L 0x10 | |
| 19 | −#define REG_CLK_DIV_FS 0x14 | |
| 20 | −#define REG_CLK_DIV_HS 0x18 | |
| 21 | −#define REG_WRCONF 0x1C | |
| 22 | −#define REG_RDCONF 0x20 | |
| 23 | −#define REG_DATA 0x24 | |
| 24 | −#define REG_STAT 0x28 | |
| 25 | − | |
| 26 | −#define I2C_STOP 0 | |
| 27 | −#define I2C_MASTER BIT(0) | |
| 28 | −#define I2C_ADDR_MODE_TEN BIT(1) | |
| 29 | −#define I2C_IRQ_MSK_ENABLE BIT(3) | |
| 30 | −#define I2C_RW_READ BIT(4) | |
| 31 | −#define I2C_CMB_RW_EN BIT(5) | |
| 32 | −#define I2C_START BIT(6) | |
| 33 | − | |
| 34 | −#define I2C_ADDR_LOW_MASK GENMASK(6, 0) | |
| 35 | −#define I2C_ADDR_LOW_SHIFT 0 | |
| 36 | −#define I2C_ADDR_HI_MASK GENMASK(2, 0) | |
| 37 | −#define I2C_ADDR_HI_SHIFT 7 | |
| 38 | − | |
| 39 | −#define I2C_WFIFO_RESET BIT(7) | |
| 40 | −#define I2C_RFIFO_RESET BIT(7) | |
| 41 | − | |
| 42 | −#define I2C_IRQ_ACK_CLEAR BIT(7) | |
| 43 | −#define I2C_INT_MASK GENMASK(6, 0) | |
| 44 | − | |
| 45 | −#define I2C_TRANS_DONE BIT(0) | |
| 46 | −#define I2C_SR_EDEVICE BIT(1) | |
| 47 | −#define I2C_SR_EDATA BIT(2) | |
| 48 | − | |
| 49 | −#define I2C_FIFO_MAX 16 | |
| 50 | − | |
| 51 | −#define I2C_TIMEOUT msecs_to_jiffies(1000) | |
| 52 | − | |
| 53 | −#define DEV(i2c) ((i2c)->adap.dev.parent) | |
| 54 | − | |
| 55 | −struct zx2967_i2c { | |
| 56 | − struct i2c_adapter adap; | |
| 57 | − struct clk *clk; | |
| 58 | − struct completion complete; | |
| 59 | − u32 clk_freq; | |
| 60 | − void __iomem *reg_base; | |
| 61 | − size_t residue; | |
| 62 | − int irq; | |
| 63 | − int msg_rd; | |
| 64 | − u8 *cur_trans; | |
| 65 | − u8 access_cnt; | |
| 66 | − int error; | |
| 67 | −}; | |
| 68 | − | |
| 69 | −static void zx2967_i2c_writel(struct zx2967_i2c *i2c, | |
| 70 | − u32 val, unsigned long reg) | |
| 71 | −{ | |
| 72 | − writel_relaxed(val, i2c->reg_base + reg); | |
| 73 | −} | |
| 74 | − | |
| 75 | −static u32 zx2967_i2c_readl(struct zx2967_i2c *i2c, unsigned long reg) | |
| 76 | −{ | |
| 77 | − return readl_relaxed(i2c->reg_base + reg); | |
| 78 | −} | |
| 79 | − | |
| 80 | −static void zx2967_i2c_writesb(struct zx2967_i2c *i2c, | |
| 81 | − void *data, unsigned long reg, int len) | |
| 82 | −{ | |
| 83 | − writesb(i2c->reg_base + reg, data, len); | |
| 84 | −} | |
| 85 | − | |
| 86 | −static void zx2967_i2c_readsb(struct zx2967_i2c *i2c, | |
| 87 | − void *data, unsigned long reg, int len) | |
| 88 | −{ | |
| 89 | − readsb(i2c->reg_base + reg, data, len); | |
| 90 | −} | |
| 91 | − | |
| 92 | −static void zx2967_i2c_start_ctrl(struct zx2967_i2c *i2c) | |
| 93 | −{ | |
| 94 | − u32 status; | |
| 95 | − u32 ctl; | |
| 96 | − | |
| 97 | − status = zx2967_i2c_readl(i2c, REG_STAT); | |
| 98 | − status |= I2C_IRQ_ACK_CLEAR; | |
| 99 | − zx2967_i2c_writel(i2c, status, REG_STAT); | |
| 100 | − | |
| 101 | − ctl = zx2967_i2c_readl(i2c, REG_CMD); | |
| 102 | − if (i2c->msg_rd) | |
| 103 | − ctl |= I2C_RW_READ; | |
| 104 | − else | |
| 105 | − ctl &= ~I2C_RW_READ; | |
| 106 | − ctl &= ~I2C_CMB_RW_EN; | |
| 107 | − ctl |= I2C_START; | |
| 108 | − zx2967_i2c_writel(i2c, ctl, REG_CMD); | |
| 109 | −} | |
| 110 | − | |
| 111 | −static void zx2967_i2c_flush_fifos(struct zx2967_i2c *i2c) | |
| 112 | −{ | |
| 113 | − u32 offset; | |
| 114 | − u32 val; | |
| 115 | − | |
| 116 | − if (i2c->msg_rd) { | |
| 117 | − offset = REG_RDCONF; | |
| 118 | − val = I2C_RFIFO_RESET; | |
| 119 | − } else { | |
| 120 | − offset = REG_WRCONF; | |
| 121 | − val = I2C_WFIFO_RESET; | |
| 122 | − } | |
| 123 | − | |
| 124 | − val |= zx2967_i2c_readl(i2c, offset); | |
| 125 | − zx2967_i2c_writel(i2c, val, offset); | |
| 126 | −} | |
| 127 | − | |
| 128 | −static int zx2967_i2c_empty_rx_fifo(struct zx2967_i2c *i2c, u32 size) | |
| 129 | −{ | |
| 130 | − u8 val[I2C_FIFO_MAX] = {0}; | |
| 131 | − int i; | |
| 132 | − | |
| 133 | − if (size > I2C_FIFO_MAX) { | |
| 134 | − dev_err(DEV(i2c), "fifo size %d over the max value %d\n", | |
| 135 | − size, I2C_FIFO_MAX); | |
| 136 | − return -EINVAL; | |
| 137 | − } | |
| 138 | − | |
| 139 | − zx2967_i2c_readsb(i2c, val, REG_DATA, size); | |
| 140 | − for (i = 0; i < size; i++) { | |
| 141 | − *i2c->cur_trans++ = val[i]; | |
| 142 | − i2c->residue--; | |
| 143 | − } | |
| 144 | − | |
| 145 | − barrier(); | |
| 146 | − | |
| 147 | − return 0; | |
| 148 | −} | |
| 149 | − | |
| 150 | −static int zx2967_i2c_fill_tx_fifo(struct zx2967_i2c *i2c) | |
| 151 | −{ | |
| 152 | − size_t residue = i2c->residue; | |
| 153 | − u8 *buf = i2c->cur_trans; | |
| 154 | − | |
| 155 | − if (residue == 0) { | |
| 156 | − dev_err(DEV(i2c), "residue is %d\n", (int)residue); | |
| 157 | − return -EINVAL; | |
| 158 | − } | |
| 159 | − | |
| 160 | − if (residue <= I2C_FIFO_MAX) { | |
| 161 | − zx2967_i2c_writesb(i2c, buf, REG_DATA, residue); | |
| 162 | − | |
| 163 | − /* Again update before writing to FIFO to make sure isr sees. */ | |
| 164 | − i2c->residue = 0; | |
| 165 | − i2c->cur_trans = NULL; | |
| 166 | − } else { | |
| 167 | − zx2967_i2c_writesb(i2c, buf, REG_DATA, I2C_FIFO_MAX); | |
| 168 | − i2c->residue -= I2C_FIFO_MAX; | |
| 169 | − i2c->cur_trans += I2C_FIFO_MAX; | |
| 170 | − } | |
| 171 | − | |
| 172 | − barrier(); | |
| 173 | − | |
| 174 | − return 0; | |
| 175 | −} | |
| 176 | − | |
| 177 | −static int zx2967_i2c_reset_hardware(struct zx2967_i2c *i2c) | |
| 178 | −{ | |
| 179 | − u32 val; | |
| 180 | − u32 clk_div; | |
| 181 | − | |
| 182 | − val = I2C_MASTER | I2C_IRQ_MSK_ENABLE; | |
| 183 | − zx2967_i2c_writel(i2c, val, REG_CMD); | |
| 184 | − | |
| 185 | − clk_div = clk_get_rate(i2c->clk) / i2c->clk_freq - 1; | |
| 186 | − zx2967_i2c_writel(i2c, clk_div, REG_CLK_DIV_FS); | |
| 187 | − zx2967_i2c_writel(i2c, clk_div, REG_CLK_DIV_HS); | |
| 188 | − | |
| 189 | − zx2967_i2c_writel(i2c, I2C_FIFO_MAX - 1, REG_WRCONF); | |
| 190 | − zx2967_i2c_writel(i2c, I2C_FIFO_MAX - 1, REG_RDCONF); | |
| 191 | − zx2967_i2c_writel(i2c, 1, REG_RDCONF); | |
| 192 | − | |
| 193 | − zx2967_i2c_flush_fifos(i2c); | |
| 194 | − | |
| 195 | − return 0; | |
| 196 | −} | |
| 197 | − | |
| 198 | −static void zx2967_i2c_isr_clr(struct zx2967_i2c *i2c) | |
| 199 | −{ | |
| 200 | − u32 status; | |
| 201 | − | |
| 202 | − status = zx2967_i2c_readl(i2c, REG_STAT); | |
| 203 | − status |= I2C_IRQ_ACK_CLEAR; | |
| 204 | − zx2967_i2c_writel(i2c, status, REG_STAT); | |
| 205 | −} | |
| 206 | − | |
| 207 | −static irqreturn_t zx2967_i2c_isr(int irq, void *dev_id) | |
| 208 | −{ | |
| 209 | − u32 status; | |
| 210 | − struct zx2967_i2c *i2c = (struct zx2967_i2c *)dev_id; | |
| 211 | − | |
| 212 | − status = zx2967_i2c_readl(i2c, REG_STAT) & I2C_INT_MASK; | |
| 213 | − zx2967_i2c_isr_clr(i2c); | |
| 214 | − | |
| 215 | − if (status & I2C_SR_EDEVICE) | |
| 216 | − i2c->error = -ENXIO; | |
| 217 | − else if (status & I2C_SR_EDATA) | |
| 218 | − i2c->error = -EIO; | |
| 219 | − else if (status & I2C_TRANS_DONE) | |
| 220 | − i2c->error = 0; | |
| 221 | − else | |
| 222 | − goto done; | |
| 223 | − | |
| 224 | − complete(&i2c->complete); | |
| 225 | −done: | |
| 226 | − return IRQ_HANDLED; | |
| 227 | −} | |
| 228 | − | |
| 229 | −static void zx2967_set_addr(struct zx2967_i2c *i2c, u16 addr) | |
| 230 | −{ | |
| 231 | − u16 val; | |
| 232 | − | |
| 233 | − val = (addr >> I2C_ADDR_LOW_SHIFT) & I2C_ADDR_LOW_MASK; | |
| 234 | − zx2967_i2c_writel(i2c, val, REG_DEVADDR_L); | |
| 235 | − | |
| 236 | − val = (addr >> I2C_ADDR_HI_SHIFT) & I2C_ADDR_HI_MASK; | |
| 237 | − zx2967_i2c_writel(i2c, val, REG_DEVADDR_H); | |
| 238 | − if (val) | |
| 239 | − val = zx2967_i2c_readl(i2c, REG_CMD) | I2C_ADDR_MODE_TEN; | |
| 240 | − else | |
| 241 | − val = zx2967_i2c_readl(i2c, REG_CMD) & ~I2C_ADDR_MODE_TEN; | |
| 242 | − zx2967_i2c_writel(i2c, val, REG_CMD); | |
| 243 | −} | |
| 244 | − | |
| 245 | −static int zx2967_i2c_xfer_bytes(struct zx2967_i2c *i2c, u32 bytes) | |
| 246 | −{ | |
| 247 | − unsigned long time_left; | |
| 248 | − int rd = i2c->msg_rd; | |
| 249 | − int ret; | |
| 250 | − | |
| 251 | − reinit_completion(&i2c->complete); | |
| 252 | − | |
| 253 | − if (rd) { | |
| 254 | − zx2967_i2c_writel(i2c, bytes - 1, REG_RDCONF); | |
| 255 | − } else { | |
| 256 | − ret = zx2967_i2c_fill_tx_fifo(i2c); | |
| 257 | − if (ret) | |
| 258 | − return ret; | |
| 259 | − } | |
| 260 | − | |
| 261 | − zx2967_i2c_start_ctrl(i2c); | |
| 262 | − | |
| 263 | − time_left = wait_for_completion_timeout(&i2c->complete, | |
| 264 | − I2C_TIMEOUT); | |
| 265 | − if (time_left == 0) | |
| 266 | − return -ETIMEDOUT; | |
| 267 | − | |
| 268 | − if (i2c->error) | |
| 269 | − return i2c->error; | |
| 270 | − | |
| 271 | − return rd ? zx2967_i2c_empty_rx_fifo(i2c, bytes) : 0; | |
| 272 | −} | |
| 273 | − | |
| 274 | −static int zx2967_i2c_xfer_msg(struct zx2967_i2c *i2c, | |
| 275 | − struct i2c_msg *msg) | |
| 276 | −{ | |
| 277 | − int ret; | |
| 278 | − int i; | |
| 279 | − | |
| 280 | − zx2967_i2c_flush_fifos(i2c); | |
| 281 | − | |
| 282 | − i2c->cur_trans = msg->buf; | |
| 283 | − i2c->residue = msg->len; | |
| 284 | − i2c->access_cnt = msg->len / I2C_FIFO_MAX; | |
| 285 | − i2c->msg_rd = msg->flags & I2C_M_RD; | |
| 286 | − | |
| 287 | − for (i = 0; i < i2c->access_cnt; i++) { | |
| 288 | − ret = zx2967_i2c_xfer_bytes(i2c, I2C_FIFO_MAX); | |
| 289 | − if (ret) | |
| 290 | − return ret; | |
| 291 | − } | |
| 292 | − | |
| 293 | − if (i2c->residue > 0) { | |
| 294 | − ret = zx2967_i2c_xfer_bytes(i2c, i2c->residue); | |
| 295 | − if (ret) | |
| 296 | − return ret; | |
| 297 | − } | |
| 298 | − | |
| 299 | − i2c->residue = 0; | |
| 300 | − i2c->access_cnt = 0; | |
| 301 | − | |
| 302 | − return 0; | |
| 303 | −} | |
| 304 | − | |
| 305 | −static int zx2967_i2c_xfer(struct i2c_adapter *adap, | |
| 306 | − struct i2c_msg *msgs, int num) | |
| 307 | −{ | |
| 308 | − struct zx2967_i2c *i2c = i2c_get_adapdata(adap); | |
| 309 | − int ret; | |
| 310 | − int i; | |
| 311 | − | |
| 312 | − zx2967_set_addr(i2c, msgs->addr); | |
| 313 | − | |
| 314 | − for (i = 0; i < num; i++) { | |
| 315 | − ret = zx2967_i2c_xfer_msg(i2c, &msgs[i]); | |
| 316 | − if (ret) | |
| 317 | − return ret; | |
| 318 | − } | |
| 319 | − | |
| 320 | − return num; | |
| 321 | −} | |
| 322 | − | |
| 323 | −static void | |
| 324 | −zx2967_smbus_xfer_prepare(struct zx2967_i2c *i2c, u16 addr, | |
| 325 | − char read_write, u8 command, int size, | |
| 326 | − union i2c_smbus_data *data) | |
| 327 | −{ | |
| 328 | − u32 val; | |
| 329 | − | |
| 330 | − val = zx2967_i2c_readl(i2c, REG_RDCONF); | |
| 331 | − val |= I2C_RFIFO_RESET; | |
| 332 | − zx2967_i2c_writel(i2c, val, REG_RDCONF); | |
| 333 | − zx2967_set_addr(i2c, addr); | |
| 334 | − val = zx2967_i2c_readl(i2c, REG_CMD); | |
| 335 | − val &= ~I2C_RW_READ; | |
| 336 | − zx2967_i2c_writel(i2c, val, REG_CMD); | |
| 337 | − | |
| 338 | − switch (size) { | |
| 339 | − case I2C_SMBUS_BYTE: | |
| 340 | − zx2967_i2c_writel(i2c, command, REG_DATA); | |
| 341 | − break; | |
| 342 | − case I2C_SMBUS_BYTE_DATA: | |
| 343 | − zx2967_i2c_writel(i2c, command, REG_DATA); | |
| 344 | − if (read_write == I2C_SMBUS_WRITE) | |
| 345 | − zx2967_i2c_writel(i2c, data->byte, REG_DATA); | |
| 346 | − break; | |
| 347 | − case I2C_SMBUS_WORD_DATA: | |
| 348 | − zx2967_i2c_writel(i2c, command, REG_DATA); | |
| 349 | − if (read_write == I2C_SMBUS_WRITE) { | |
| 350 | − zx2967_i2c_writel(i2c, (data->word >> 8), REG_DATA); | |
| 351 | − zx2967_i2c_writel(i2c, (data->word & 0xff), | |
| 352 | − REG_DATA); | |
| 353 | − } | |
| 354 | − break; | |
| 355 | − } | |
| 356 | −} | |
| 357 | − | |
| 358 | −static int zx2967_smbus_xfer_read(struct zx2967_i2c *i2c, int size, | |
| 359 | − union i2c_smbus_data *data) | |
| 360 | −{ | |
| 361 | − unsigned long time_left; | |
| 362 | − u8 buf[2]; | |
| 363 | − u32 val; | |
| 364 | − | |
| 365 | − reinit_completion(&i2c->complete); | |
| 366 | − | |
| 367 | − val = zx2967_i2c_readl(i2c, REG_CMD); | |
| 368 | − val |= I2C_CMB_RW_EN; | |
| 369 | − zx2967_i2c_writel(i2c, val, REG_CMD); | |
| 370 | − | |
| 371 | − val = zx2967_i2c_readl(i2c, REG_CMD); | |
| 372 | − val |= I2C_START; | |
| 373 | − zx2967_i2c_writel(i2c, val, REG_CMD); | |
| 374 | − | |
| 375 | − time_left = wait_for_completion_timeout(&i2c->complete, | |
| 376 | − I2C_TIMEOUT); | |
| 377 | − if (time_left == 0) | |
| 378 | − return -ETIMEDOUT; | |
| 379 | − | |
| 380 | − if (i2c->error) | |
| 381 | − return i2c->error; | |
| 382 | − | |
| 383 | − switch (size) { | |
| 384 | − case I2C_SMBUS_BYTE: | |
| 385 | − case I2C_SMBUS_BYTE_DATA: | |
| 386 | − val = zx2967_i2c_readl(i2c, REG_DATA); | |
| 387 | − data->byte = val; | |
| 388 | − break; | |
| 389 | − case I2C_SMBUS_WORD_DATA: | |
| 390 | − case I2C_SMBUS_PROC_CALL: | |
| 391 | − buf[0] = zx2967_i2c_readl(i2c, REG_DATA); | |
| 392 | − buf[1] = zx2967_i2c_readl(i2c, REG_DATA); | |
| 393 | − data->word = (buf[0] << 8) | buf[1]; | |
| 394 | − break; | |
| 395 | − default: | |
| 396 | − return -EOPNOTSUPP; | |
| 397 | − } | |
| 398 | − | |
| 399 | − return 0; | |
| 400 | −} | |
| 401 | − | |
| 402 | −static int zx2967_smbus_xfer_write(struct zx2967_i2c *i2c) | |
| 403 | −{ | |
| 404 | − unsigned long time_left; | |
| 405 | − u32 val; | |
| 406 | − | |
| 407 | − reinit_completion(&i2c->complete); | |
| 408 | − val = zx2967_i2c_readl(i2c, REG_CMD); | |
| 409 | − val |= I2C_START; | |
| 410 | − zx2967_i2c_writel(i2c, val, REG_CMD); | |
| 411 | − | |
| 412 | − time_left = wait_for_completion_timeout(&i2c->complete, | |
| 413 | − I2C_TIMEOUT); | |
| 414 | − if (time_left == 0) | |
| 415 | − return -ETIMEDOUT; | |
| 416 | − | |
| 417 | − if (i2c->error) | |
| 418 | − return i2c->error; | |
| 419 | − | |
| 420 | − return 0; | |
| 421 | −} | |
| 422 | − | |
| 423 | −static int zx2967_smbus_xfer(struct i2c_adapter *adap, u16 addr, | |
| 424 | − unsigned short flags, char read_write, | |
| 425 | − u8 command, int size, union i2c_smbus_data *data) | |
| 426 | −{ | |
| 427 | − struct zx2967_i2c *i2c = i2c_get_adapdata(adap); | |
| 428 | − | |
| 429 | − if (size == I2C_SMBUS_QUICK) | |
| 430 | − read_write = I2C_SMBUS_WRITE; | |
| 431 | − | |
| 432 | − switch (size) { | |
| 433 | − case I2C_SMBUS_QUICK: | |
| 434 | − case I2C_SMBUS_BYTE: | |
| 435 | − case I2C_SMBUS_BYTE_DATA: | |
| 436 | − case I2C_SMBUS_WORD_DATA: | |
| 437 | − zx2967_smbus_xfer_prepare(i2c, addr, read_write, | |
| 438 | − command, size, data); | |
| 439 | − break; | |
| 440 | − default: | |
| 441 | − return -EOPNOTSUPP; | |
| 442 | − } | |
| 443 | − | |
| 444 | − if (read_write == I2C_SMBUS_READ) | |
| 445 | − return zx2967_smbus_xfer_read(i2c, size, data); | |
| 446 | − | |
| 447 | − return zx2967_smbus_xfer_write(i2c); | |
| 448 | −} | |
| 449 | − | |
| 450 | −static u32 zx2967_i2c_func(struct i2c_adapter *adap) | |
| 451 | −{ | |
| 452 | − return I2C_FUNC_I2C | | |
| 453 | − I2C_FUNC_SMBUS_QUICK | | |
| 454 | − I2C_FUNC_SMBUS_BYTE | | |
| 455 | − I2C_FUNC_SMBUS_BYTE_DATA | | |
| 456 | − I2C_FUNC_SMBUS_WORD_DATA | | |
| 457 | − I2C_FUNC_SMBUS_BLOCK_DATA | | |
| 458 | − I2C_FUNC_SMBUS_PROC_CALL | | |
| 459 | − I2C_FUNC_SMBUS_I2C_BLOCK; | |
| 460 | −} | |
| 461 | − | |
| 462 | −static int __maybe_unused zx2967_i2c_suspend(struct device *dev) | |
| 463 | −{ | |
| 464 | − struct zx2967_i2c *i2c = dev_get_drvdata(dev); | |
| 465 | − | |
| 466 | − i2c_mark_adapter_suspended(&i2c->adap); | |
| 467 | − clk_disable_unprepare(i2c->clk); | |
| 468 | − | |
| 469 | − return 0; | |
| 470 | −} | |
| 471 | − | |
| 472 | −static int __maybe_unused zx2967_i2c_resume(struct device *dev) | |
| 473 | −{ | |
| 474 | − struct zx2967_i2c *i2c = dev_get_drvdata(dev); | |
| 475 | − | |
| 476 | − clk_prepare_enable(i2c->clk); | |
| 477 | − i2c_mark_adapter_resumed(&i2c->adap); | |
| 478 | − | |
| 479 | − return 0; | |
| 480 | −} | |
| 481 | − | |
| 482 | −static SIMPLE_DEV_PM_OPS(zx2967_i2c_dev_pm_ops, | |
| 483 | − zx2967_i2c_suspend, zx2967_i2c_resume); | |
| 484 | − | |
| 485 | −static const struct i2c_algorithm zx2967_i2c_algo = { | |
| 486 | − .master_xfer = zx2967_i2c_xfer, | |
| 487 | − .smbus_xfer = zx2967_smbus_xfer, | |
| 488 | − .functionality = zx2967_i2c_func, | |
| 489 | −}; | |
| 490 | − | |
| 491 | −static const struct i2c_adapter_quirks zx2967_i2c_quirks = { | |
| 492 | − .flags = I2C_AQ_NO_ZERO_LEN, | |
| 493 | −}; | |
| 494 | − | |
| 495 | −static const struct of_device_id zx2967_i2c_of_match[] = { | |
| 496 | − { .compatible = "zte,zx296718-i2c", }, | |
| 497 | − { }, | |
| 498 | −}; | |
| 499 | −MODULE_DEVICE_TABLE(of, zx2967_i2c_of_match); | |
| 500 | − | |
| 501 | −static int zx2967_i2c_probe(struct platform_device *pdev) | |
| 502 | −{ | |
| 503 | − struct zx2967_i2c *i2c; | |
| 504 | − void __iomem *reg_base; | |
| 505 | − struct clk *clk; | |
| 506 | − int ret; | |
| 507 | − | |
| 508 | − i2c = devm_kzalloc(&pdev->dev, sizeof(*i2c), GFP_KERNEL); | |
| 509 | − if (!i2c) | |
| 510 | − return -ENOMEM; | |
| 511 | − | |
| 512 | − reg_base = devm_platform_ioremap_resource(pdev, 0); | |
| 513 | − if (IS_ERR(reg_base)) | |
| 514 | − return PTR_ERR(reg_base); | |
| 515 | − | |
| 516 | − clk = devm_clk_get(&pdev->dev, NULL); | |
| 517 | − if (IS_ERR(clk)) { | |
| 518 | − dev_err(&pdev->dev, "missing controller clock"); | |
| 519 | − return PTR_ERR(clk); | |
| 520 | − } | |
| 521 | − | |
| 522 | − ret = clk_prepare_enable(clk); | |
| 523 | − if (ret) { | |
| 524 | − dev_err(&pdev->dev, "failed to enable i2c_clk\n"); | |
| 525 | − return ret; | |
| 526 | − } | |
| 527 | − | |
| 528 | − ret = device_property_read_u32(&pdev->dev, "clock-frequency", | |
| 529 | − &i2c->clk_freq); | |
| 530 | − if (ret) { | |
| 531 | − dev_err(&pdev->dev, "missing clock-frequency"); | |
| 532 | − return ret; | |
| 533 | − } | |
| 534 | − | |
| 535 | − ret = platform_get_irq(pdev, 0); | |
| 536 | − if (ret < 0) | |
| 537 | − return ret; | |
| 538 | − | |
| 539 | − i2c->irq = ret; | |
| 540 | − i2c->reg_base = reg_base; | |
| 541 | − i2c->clk = clk; | |
| 542 | − | |
| 543 | − init_completion(&i2c->complete); | |
| 544 | − platform_set_drvdata(pdev, i2c); | |
| 545 | − | |
| 546 | − ret = zx2967_i2c_reset_hardware(i2c); | |
| 547 | − if (ret) { | |
| 548 | − dev_err(&pdev->dev, "failed to initialize i2c controller\n"); | |
| 549 | − goto err_clk_unprepare; | |
| 550 | − } | |
| 551 | − | |
| 552 | − ret = devm_request_irq(&pdev->dev, i2c->irq, | |
| 553 | − zx2967_i2c_isr, 0, dev_name(&pdev->dev), i2c); | |
| 554 | − if (ret) { | |
| 555 | − dev_err(&pdev->dev, "failed to request irq %i\n", i2c->irq); | |
| 556 | − goto err_clk_unprepare; | |
| 557 | − } | |
| 558 | − | |
| 559 | − i2c_set_adapdata(&i2c->adap, i2c); | |
| 560 | − strlcpy(i2c->adap.name, "zx2967 i2c adapter", | |
| 561 | − sizeof(i2c->adap.name)); | |
| 562 | − i2c->adap.algo = &zx2967_i2c_algo; | |
| 563 | − i2c->adap.quirks = &zx2967_i2c_quirks; | |
| 564 | − i2c->adap.nr = pdev->id; | |
| 565 | − i2c->adap.dev.parent = &pdev->dev; | |
| 566 | − i2c->adap.dev.of_node = pdev->dev.of_node; | |
| 567 | − | |
| 568 | − ret = i2c_add_numbered_adapter(&i2c->adap); | |
| 569 | − if (ret) | |
| 570 | − goto err_clk_unprepare; | |
| 571 | − | |
| 572 | − return 0; | |
| 573 | − | |
| 574 | −err_clk_unprepare: | |
| 575 | − clk_disable_unprepare(i2c->clk); | |
| 576 | − return ret; | |
| 577 | −} | |
| 578 | − | |
| 579 | −static int zx2967_i2c_remove(struct platform_device *pdev) | |
| 580 | −{ | |
| 581 | − struct zx2967_i2c *i2c = platform_get_drvdata(pdev); | |
| 582 | − | |
| 583 | − i2c_del_adapter(&i2c->adap); | |
| 584 | − clk_disable_unprepare(i2c->clk); | |
| 585 | − | |
| 586 | − return 0; | |
| 587 | −} | |
| 588 | − | |
| 589 | −static struct platform_driver zx2967_i2c_driver = { | |
| 590 | − .probe = zx2967_i2c_probe, | |
| 591 | − .remove = zx2967_i2c_remove, | |
| 592 | − .driver = { | |
| 593 | − .name = "zx2967_i2c", | |
| 594 | − .of_match_table = zx2967_i2c_of_match, | |
| 595 | − .pm = &zx2967_i2c_dev_pm_ops, | |
| 596 | − }, | |
| 597 | −}; | |
| 598 | −module_platform_driver(zx2967_i2c_driver); | |
| 599 | − | |
| 600 | −MODULE_AUTHOR("Baoyou Xie <baoyou.xie@linaro.org>"); | |
| 601 | −MODULE_DESCRIPTION("ZTE ZX2967 I2C Bus Controller driver"); | |
| 602 | −MODULE_LICENSE("GPL v2"); | |
| @@ -225,12 +225,8 @@ static void i2c_acpi_register_device(struct i2c_adapter *adapter, · 224 unmodified lines | ||
| 225 | 225 | adev->power.flags.ignore_parent = true; |
| 226 | 226 | acpi_device_set_enumerated(adev); |
| 227 | 227 | |
| 228 | − if (IS_ERR(i2c_new_client_device(adapter, info))) { | |
| 228 | + if (IS_ERR(i2c_new_client_device(adapter, info))) | |
| 229 | 229 | adev->power.flags.ignore_parent = false; |
| 230 | − dev_err(&adapter->dev, | |
| 231 | − "failed to add I2C device %s from ACPI\n", | |
| 232 | − dev_name(&adev->dev)); | |
| 233 | − } | |
| 234 | 230 | } |
| 235 | 231 | |
| 236 | 232 | static acpi_status i2c_acpi_add_device(acpi_handle handle, u32 level, |
| @@ -323,8 +323,7 @@ static s32 i2c_smbus_xfer_emulated(struct i2c_adapter *adapter, u16 addr, · 322 unmodified lines | ||
| 323 | 323 | */ |
| 324 | 324 | unsigned char msgbuf0[I2C_SMBUS_BLOCK_MAX+3]; |
| 325 | 325 | unsigned char msgbuf1[I2C_SMBUS_BLOCK_MAX+2]; |
| 326 | − int num = read_write == I2C_SMBUS_READ ? 2 : 1; | |
| 327 | − int i; | |
| 326 | + int nmsgs = read_write == I2C_SMBUS_READ ? 2 : 1; | |
| 328 | 327 | u8 partial_pec = 0; |
| 329 | 328 | int status; |
| 330 | 329 | struct i2c_msg msg[2] = { |
| @@ -340,6 +339,8 @@ static s32 i2c_smbus_xfer_emulated(struct i2c_adapter *adapter, u16 addr, · 9 unmodified lines | ||
| 340 | 339 | .buf = msgbuf1, |
| 341 | 340 | }, |
| 342 | 341 | }; |
| 342 | + bool wants_pec = ((flags & I2C_CLIENT_PEC) && size != I2C_SMBUS_QUICK | |
| 343 | + && size != I2C_SMBUS_I2C_BLOCK_DATA); | |
| 343 | 344 | |
| 344 | 345 | msgbuf0[0] = command; |
| 345 | 346 | switch (size) { |
| @@ -348,13 +349,13 @@ static s32 i2c_smbus_xfer_emulated(struct i2c_adapter *adapter, u16 addr, · 2 unmodified lines | ||
| 348 | 349 | /* Special case: The read/write field is used as data */ |
| 349 | 350 | msg[0].flags = flags | (read_write == I2C_SMBUS_READ ? |
| 350 | 351 | I2C_M_RD : 0); |
| 351 | − num = 1; | |
| 352 | + nmsgs = 1; | |
| 352 | 353 | break; |
| 353 | 354 | case I2C_SMBUS_BYTE: |
| 354 | 355 | if (read_write == I2C_SMBUS_READ) { |
| 355 | 356 | /* Special case: only a read! */ |
| 356 | 357 | msg[0].flags = I2C_M_RD | flags; |
| 357 | − num = 1; | |
| 358 | + nmsgs = 1; | |
| 358 | 359 | } |
| 359 | 360 | break; |
| 360 | 361 | case I2C_SMBUS_BYTE_DATA: |
| @@ -375,7 +376,7 @@ static s32 i2c_smbus_xfer_emulated(struct i2c_adapter *adapter, u16 addr, · 14 unmodified lines | ||
| 375 | 376 | } |
| 376 | 377 | break; |
| 377 | 378 | case I2C_SMBUS_PROC_CALL: |
| 378 | − num = 2; /* Special case */ | |
| 379 | + nmsgs = 2; /* Special case */ | |
| 379 | 380 | read_write = I2C_SMBUS_READ; |
| 380 | 381 | msg[0].len = 3; |
| 381 | 382 | msg[1].len = 2; |
| @@ -398,12 +399,11 @@ static s32 i2c_smbus_xfer_emulated(struct i2c_adapter *adapter, u16 addr, · 16 unmodified lines | ||
| 398 | 399 | } |
| 399 | 400 | |
| 400 | 401 | i2c_smbus_try_get_dmabuf(&msg[0], command); |
| 401 | − for (i = 1; i < msg[0].len; i++) | |
| 402 | − msg[0].buf[i] = data->block[i - 1]; | |
| 402 | + memcpy(msg[0].buf + 1, data->block, msg[0].len - 1); | |
| 403 | 403 | } |
| 404 | 404 | break; |
| 405 | 405 | case I2C_SMBUS_BLOCK_PROC_CALL: |
| 406 | − num = 2; /* Another special case */ | |
| 406 | + nmsgs = 2; /* Another special case */ | |
| 407 | 407 | read_write = I2C_SMBUS_READ; |
| 408 | 408 | if (data->block[0] > I2C_SMBUS_BLOCK_MAX) { |
| 409 | 409 | dev_err(&adapter->dev, |
| @@ -414,8 +414,7 @@ static s32 i2c_smbus_xfer_emulated(struct i2c_adapter *adapter, u16 addr, · 4 unmodified lines | ||
| 414 | 414 | |
| 415 | 415 | msg[0].len = data->block[0] + 2; |
| 416 | 416 | i2c_smbus_try_get_dmabuf(&msg[0], command); |
| 417 | − for (i = 1; i < msg[0].len; i++) | |
| 418 | − msg[0].buf[i] = data->block[i - 1]; | |
| 417 | + memcpy(msg[0].buf + 1, data->block, msg[0].len - 1); | |
| 419 | 418 | |
| 420 | 419 | msg[1].flags |= I2C_M_RECV_LEN; |
| 421 | 420 | msg[1].len = 1; /* block length will be added by |
| @@ -437,8 +436,7 @@ static s32 i2c_smbus_xfer_emulated(struct i2c_adapter *adapter, u16 addr, · 15 unmodified lines | ||
| 437 | 436 | msg[0].len = data->block[0] + 1; |
| 438 | 437 | |
| 439 | 438 | i2c_smbus_try_get_dmabuf(&msg[0], command); |
| 440 | − for (i = 1; i <= data->block[0]; i++) | |
| 441 | − msg[0].buf[i] = data->block[i]; | |
| 439 | + memcpy(msg[0].buf + 1, data->block + 1, data->block[0]); | |
| 442 | 440 | } |
| 443 | 441 | break; |
| 444 | 442 | default: |
| @@ -446,33 +444,31 @@ static s32 i2c_smbus_xfer_emulated(struct i2c_adapter *adapter, u16 addr, · 1 unmodified line | ||
| 446 | 444 | return -EOPNOTSUPP; |
| 447 | 445 | } |
| 448 | 446 | |
| 449 | − i = ((flags & I2C_CLIENT_PEC) && size != I2C_SMBUS_QUICK | |
| 450 | − && size != I2C_SMBUS_I2C_BLOCK_DATA); | |
| 451 | − if (i) { | |
| 447 | + if (wants_pec) { | |
| 452 | 448 | /* Compute PEC if first message is a write */ |
| 453 | 449 | if (!(msg[0].flags & I2C_M_RD)) { |
| 454 | − if (num == 1) /* Write only */ | |
| 450 | + if (nmsgs == 1) /* Write only */ | |
| 455 | 451 | i2c_smbus_add_pec(&msg[0]); |
| 456 | 452 | else /* Write followed by read */ |
| 457 | 453 | partial_pec = i2c_smbus_msg_pec(0, &msg[0]); |
| 458 | 454 | } |
| 459 | 455 | /* Ask for PEC if last message is a read */ |
| 460 | − if (msg[num-1].flags & I2C_M_RD) | |
| 461 | − msg[num-1].len++; | |
| 456 | + if (msg[nmsgs - 1].flags & I2C_M_RD) | |
| 457 | + msg[nmsgs - 1].len++; | |
| 462 | 458 | } |
| 463 | 459 | |
| 464 | − status = __i2c_transfer(adapter, msg, num); | |
| 460 | + status = __i2c_transfer(adapter, msg, nmsgs); | |
| 465 | 461 | if (status < 0) |
| 466 | 462 | goto cleanup; |
| 467 | − if (status != num) { | |
| 463 | + if (status != nmsgs) { | |
| 468 | 464 | status = -EIO; |
| 469 | 465 | goto cleanup; |
| 470 | 466 | } |
| 471 | 467 | status = 0; |
| 472 | 468 | |
| 473 | 469 | /* Check PEC if last message is a read */ |
| 474 | − if (i && (msg[num-1].flags & I2C_M_RD)) { | |
| 475 | − status = i2c_smbus_check_pec(partial_pec, &msg[num-1]); | |
| 470 | + if (wants_pec && (msg[nmsgs - 1].flags & I2C_M_RD)) { | |
| 471 | + status = i2c_smbus_check_pec(partial_pec, &msg[nmsgs - 1]); | |
| 476 | 472 | if (status < 0) |
| 477 | 473 | goto cleanup; |
| 478 | 474 | } |
| @@ -490,8 +486,7 @@ static s32 i2c_smbus_xfer_emulated(struct i2c_adapter *adapter, u16 addr, · 11 unmodified lines | ||
| 490 | 486 | data->word = msgbuf1[0] | (msgbuf1[1] << 8); |
| 491 | 487 | break; |
| 492 | 488 | case I2C_SMBUS_I2C_BLOCK_DATA: |
| 493 | − for (i = 0; i < data->block[0]; i++) | |
| 494 | − data->block[i + 1] = msg[1].buf[i]; | |
| 489 | + memcpy(data->block + 1, msg[1].buf, data->block[0]); | |
| 495 | 490 | break; |
| 496 | 491 | case I2C_SMBUS_BLOCK_DATA: |
| 497 | 492 | case I2C_SMBUS_BLOCK_PROC_CALL: |
| @@ -502,8 +497,7 @@ static s32 i2c_smbus_xfer_emulated(struct i2c_adapter *adapter, u16 addr, · 4 unmodified lines | ||
| 502 | 497 | status = -EPROTO; |
| 503 | 498 | goto cleanup; |
| 504 | 499 | } |
| 505 | − for (i = 0; i < msg[1].buf[0] + 1; i++) | |
| 506 | − data->block[i] = msg[1].buf[i]; | |
| 500 | + memcpy(data->block, msg[1].buf, msg[1].buf[0] + 1); | |
| 507 | 501 | break; |
| 508 | 502 | } |
| 509 | 503 | |
| @@ -19,6 +19,7 @@ · 18 unmodified lines | ||
| 19 | 19 | enum testunit_cmds { |
| 20 | 20 | TU_CMD_READ_BYTES = 1, /* save 0 for ABORT, RESET or similar */ |
| 21 | 21 | TU_CMD_HOST_NOTIFY, |
| 22 | + TU_CMD_SMBUS_BLOCK_PROC_CALL, | |
| 22 | 23 | TU_NUM_CMDS |
| 23 | 24 | }; |
| 24 | 25 | |
| @@ -88,6 +89,8 @@ static int i2c_slave_testunit_slave_cb(struct i2c_client *client, · 63 unmodified lines | ||
| 88 | 89 | enum i2c_slave_event event, u8 *val) |
| 89 | 90 | { |
| 90 | 91 | struct testunit_data *tu = i2c_get_clientdata(client); |
| 92 | + bool is_proc_call = tu->reg_idx == 3 && tu->regs[TU_REG_DATAL] == 1 && | |
| 93 | + tu->regs[TU_REG_CMD] == TU_CMD_SMBUS_BLOCK_PROC_CALL; | |
| 91 | 94 | int ret = 0; |
| 92 | 95 | |
| 93 | 96 | switch (event) { |
| @@ -118,12 +121,17 @@ static int i2c_slave_testunit_slave_cb(struct i2c_client *client, · 24 unmodified lines | ||
| 118 | 121 | fallthrough; |
| 119 | 122 | |
| 120 | 123 | case I2C_SLAVE_WRITE_REQUESTED: |
| 124 | + memset(tu->regs, 0, TU_NUM_REGS); | |
| 121 | 125 | tu->reg_idx = 0; |
| 122 | 126 | break; |
| 123 | 127 | |
| 124 | − case I2C_SLAVE_READ_REQUESTED: | |
| 125 | 128 | case I2C_SLAVE_READ_PROCESSED: |
| 126 | − *val = TU_CUR_VERSION; | |
| 129 | + if (is_proc_call && tu->regs[TU_REG_DATAH]) | |
| 130 | + tu->regs[TU_REG_DATAH]--; | |
| 131 | + fallthrough; | |
| 132 | + | |
| 133 | + case I2C_SLAVE_READ_REQUESTED: | |
| 134 | + *val = is_proc_call ? tu->regs[TU_REG_DATAH] : TU_CUR_VERSION; | |
| 127 | 135 | break; |
| 128 | 136 | } |
| 129 | 137 | |
| @@ -7,7 +7,6 @@ · 6 unmodified lines | ||
| 7 | 7 | |
| 8 | 8 | */ |
| 9 | 9 | |
| 10 | −#define DEBUG 1 | |
| 11 | 10 | #define pr_fmt(fmt) "i2c-stub: " fmt |
| 12 | 11 | |
| 13 | 12 | #include <linux/errno.h> |
| @@ -49,60 +49,112 @@ static int i2c_mux_gpio_deselect(struct i2c_mux_core *muxc, u32 chan) · 48 unmodified lines | ||
| 49 | 49 | return 0; |
| 50 | 50 | } |
| 51 | 51 | |
| 52 | −#ifdef CONFIG_OF | |
| 53 | −static int i2c_mux_gpio_probe_dt(struct gpiomux *mux, | |
| 54 | − struct platform_device *pdev) | |
| 52 | +#ifdef CONFIG_ACPI | |
| 53 | + | |
| 54 | +static int i2c_mux_gpio_get_acpi_adr(struct device *dev, | |
| 55 | + struct fwnode_handle *fwdev, | |
| 56 | + unsigned int *adr) | |
| 57 | + | |
| 58 | +{ | |
| 59 | + unsigned long long adr64; | |
| 60 | + acpi_status status; | |
| 61 | + | |
| 62 | + status = acpi_evaluate_integer(ACPI_HANDLE_FWNODE(fwdev), | |
| 63 | + METHOD_NAME__ADR, | |
| 64 | + NULL, &adr64); | |
| 65 | + | |
| 66 | + if (!ACPI_SUCCESS(status)) { | |
| 67 | + dev_err(dev, "Cannot get address\n"); | |
| 68 | + return -EINVAL; | |
| 69 | + } | |
| 70 | + | |
| 71 | + *adr = adr64; | |
| 72 | + if (*adr != adr64) { | |
| 73 | + dev_err(dev, "Address out of range\n"); | |
| 74 | + return -ERANGE; | |
| 75 | + } | |
| 76 | + | |
| 77 | + return 0; | |
| 78 | +} | |
| 79 | + | |
| 80 | +#else | |
| 81 | + | |
| 82 | +static int i2c_mux_gpio_get_acpi_adr(struct device *dev, | |
| 83 | + struct fwnode_handle *fwdev, | |
| 84 | + unsigned int *adr) | |
| 85 | +{ | |
| 86 | + return -EINVAL; | |
| 87 | +} | |
| 88 | + | |
| 89 | +#endif | |
| 90 | + | |
| 91 | +static int i2c_mux_gpio_probe_fw(struct gpiomux *mux, | |
| 92 | + struct platform_device *pdev) | |
| 55 | 93 | { |
| 56 | − struct device_node *np = pdev->dev.of_node; | |
| 57 | − struct device_node *adapter_np, *child; | |
| 58 | − struct i2c_adapter *adapter; | |
| 94 | + struct device *dev = &pdev->dev; | |
| 95 | + struct device_node *np = dev->of_node; | |
| 96 | + struct device_node *adapter_np; | |
| 97 | + struct i2c_adapter *adapter = NULL; | |
| 98 | + struct fwnode_handle *child; | |
| 59 | 99 | unsigned *values; |
| 60 | − int i = 0; | |
| 100 | + int rc, i = 0; | |
| 101 | + | |
| 102 | + if (is_of_node(dev->fwnode)) { | |
| 103 | + if (!np) | |
| 104 | + return -ENODEV; | |
| 61 | 105 | |
| 62 | − if (!np) | |
| 63 | − return -ENODEV; | |
| 106 | + adapter_np = of_parse_phandle(np, "i2c-parent", 0); | |
| 107 | + if (!adapter_np) { | |
| 108 | + dev_err(&pdev->dev, "Cannot parse i2c-parent\n"); | |
| 109 | + return -ENODEV; | |
| 110 | + } | |
| 111 | + adapter = of_find_i2c_adapter_by_node(adapter_np); | |
| 112 | + of_node_put(adapter_np); | |
| 113 | + | |
| 114 | + } else if (is_acpi_node(dev->fwnode)) { | |
| 115 | + /* | |
| 116 | + * In ACPI land the mux should be a direct child of the i2c | |
| 117 | + * bus it muxes. | |
| 118 | + */ | |
| 119 | + acpi_handle dev_handle = ACPI_HANDLE(dev->parent); | |
| 64 | 120 | |
| 65 | − adapter_np = of_parse_phandle(np, "i2c-parent", 0); | |
| 66 | − if (!adapter_np) { | |
| 67 | − dev_err(&pdev->dev, "Cannot parse i2c-parent\n"); | |
| 68 | − return -ENODEV; | |
| 121 | + adapter = i2c_acpi_find_adapter_by_handle(dev_handle); | |
| 69 | 122 | } |
| 70 | − adapter = of_find_i2c_adapter_by_node(adapter_np); | |
| 71 | − of_node_put(adapter_np); | |
| 123 | + | |
| 72 | 124 | if (!adapter) |
| 73 | 125 | return -EPROBE_DEFER; |
| 74 | 126 | |
| 75 | 127 | mux->data.parent = i2c_adapter_id(adapter); |
| 76 | 128 | put_device(&adapter->dev); |
| 77 | 129 | |
| 78 | − mux->data.n_values = of_get_child_count(np); | |
| 79 | − | |
| 80 | − values = devm_kcalloc(&pdev->dev, | |
| 130 | + mux->data.n_values = device_get_child_node_count(dev); | |
| 131 | + values = devm_kcalloc(dev, | |
| 81 | 132 | mux->data.n_values, sizeof(*mux->data.values), |
| 82 | 133 | GFP_KERNEL); |
| 83 | 134 | if (!values) { |
| 84 | − dev_err(&pdev->dev, "Cannot allocate values array"); | |
| 135 | + dev_err(dev, "Cannot allocate values array"); | |
| 85 | 136 | return -ENOMEM; |
| 86 | 137 | } |
| 87 | 138 | |
| 88 | − for_each_child_of_node(np, child) { | |
| 89 | − of_property_read_u32(child, "reg", values + i); | |
| 139 | + device_for_each_child_node(dev, child) { | |
| 140 | + if (is_of_node(child)) { | |
| 141 | + fwnode_property_read_u32(child, "reg", values + i); | |
| 142 | + | |
| 143 | + } else if (is_acpi_node(child)) { | |
| 144 | + rc = i2c_mux_gpio_get_acpi_adr(dev, child, values + i); | |
| 145 | + if (rc) | |
| 146 | + return rc; | |
| 147 | + } | |
| 148 | + | |
| 90 | 149 | i++; |
| 91 | 150 | } |
| 92 | 151 | mux->data.values = values; |
| 93 | 152 | |
| 94 | − if (of_property_read_u32(np, "idle-state", &mux->data.idle)) | |
| 153 | + if (fwnode_property_read_u32(dev->fwnode, "idle-state", &mux->data.idle)) | |
| 95 | 154 | mux->data.idle = I2C_MUX_GPIO_NO_IDLE; |
| 96 | 155 | |
| 97 | 156 | return 0; |
| 98 | 157 | } |
| 99 | −#else | |
| 100 | −static int i2c_mux_gpio_probe_dt(struct gpiomux *mux, | |
| 101 | − struct platform_device *pdev) | |
| 102 | −{ | |
| 103 | − return 0; | |
| 104 | −} | |
| 105 | −#endif | |
| 106 | 158 | |
| 107 | 159 | static int i2c_mux_gpio_probe(struct platform_device *pdev) |
| 108 | 160 | { |
| @@ -118,7 +170,7 @@ static int i2c_mux_gpio_probe(struct platform_device *pdev) · 9 unmodified lines | ||
| 118 | 170 | return -ENOMEM; |
| 119 | 171 | |
| 120 | 172 | if (!dev_get_platdata(&pdev->dev)) { |
| 121 | − ret = i2c_mux_gpio_probe_dt(mux, pdev); | |
| 173 | + ret = i2c_mux_gpio_probe_fw(mux, pdev); | |
| 122 | 174 | if (ret < 0) |
| 123 | 175 | return ret; |
| 124 | 176 | } else { |
| @@ -1,35 +1,8 @@ | ||
| 1 | +// SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0 | |
| 1 | 2 | /* |
| 2 | − * drivers/i2c/muxes/i2c-mux-mlxcpld.c | |
| 3 | − * Copyright (c) 2016 Mellanox Technologies. All rights reserved. | |
| 4 | − * Copyright (c) 2016 Michael Shych <michaels@mellanox.com> | |
| 3 | + * Mellanox i2c mux driver | |
| 5 | 4 | * |
| 6 | − * Redistribution and use in source and binary forms, with or without | |
| 7 | − * modification, are permitted provided that the following conditions are met: | |
| 8 | − * | |
| 9 | − * 1. Redistributions of source code must retain the above copyright | |
| 10 | − * notice, this list of conditions and the following disclaimer. | |
| 11 | − * 2. Redistributions in binary form must reproduce the above copyright | |
| 12 | − * notice, this list of conditions and the following disclaimer in the | |
| 13 | − * documentation and/or other materials provided with the distribution. | |
| 14 | − * 3. Neither the names of the copyright holders nor the names of its | |
| 15 | − * contributors may be used to endorse or promote products derived from | |
| 16 | − * this software without specific prior written permission. | |
| 17 | − * | |
| 18 | − * Alternatively, this software may be distributed under the terms of the | |
| 19 | − * GNU General Public License ("GPL") version 2 as published by the Free | |
| 20 | − * Software Foundation. | |
| 21 | − * | |
| 22 | − * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" | |
| 23 | − * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE | |
| 24 | − * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE | |
| 25 | − * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE | |
| 26 | − * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR | |
| 27 | − * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF | |
| 28 | − * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS | |
| 29 | − * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN | |
| 30 | − * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) | |
| 31 | − * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE | |
| 32 | − * POSSIBILITY OF SUCH DAMAGE. | |
| 5 | + * Copyright (C) 2016-2020 Mellanox Technologies | |
| 33 | 6 | */ |
| 34 | 7 | |
| 35 | 8 | #include <linux/device.h> |
| @@ -38,19 +11,19 @@ · 2 unmodified lines | ||
| 38 | 11 | #include <linux/io.h> |
| 39 | 12 | #include <linux/init.h> |
| 40 | 13 | #include <linux/module.h> |
| 41 | −#include <linux/platform_data/x86/mlxcpld.h> | |
| 14 | +#include <linux/platform_data/mlxcpld.h> | |
| 42 | 15 | #include <linux/platform_device.h> |
| 43 | 16 | #include <linux/slab.h> |
| 44 | 17 | |
| 45 | −#define CPLD_MUX_MAX_NCHANS 8 | |
| 46 | − | |
| 47 | 18 | /* mlxcpld_mux - mux control structure: |
| 48 | − * @last_chan - last register value | |
| 19 | + * @last_val - last selected register value or -1 if mux deselected | |
| 49 | 20 | * @client - I2C device client |
| 21 | + * @pdata: platform data | |
| 50 | 22 | */ |
| 51 | 23 | struct mlxcpld_mux { |
| 52 | − u8 last_chan; | |
| 24 | + int last_val; | |
| 53 | 25 | struct i2c_client *client; |
| 26 | + struct mlxcpld_mux_plat_data pdata; | |
| 54 | 27 | }; |
| 55 | 28 | |
| 56 | 29 | /* MUX logic description. |
| @@ -81,37 +54,50 @@ struct mlxcpld_mux { · 24 unmodified lines | ||
| 81 | 54 | * |
| 82 | 55 | */ |
| 83 | 56 | |
| 84 | −static const struct i2c_device_id mlxcpld_mux_id[] = { | |
| 85 | − { "mlxcpld_mux_module", 0 }, | |
| 86 | − { } | |
| 87 | −}; | |
| 88 | −MODULE_DEVICE_TABLE(i2c, mlxcpld_mux_id); | |
| 89 | − | |
| 90 | 57 | /* Write to mux register. Don't use i2c_transfer() and i2c_smbus_xfer() |
| 91 | 58 | * for this as they will try to lock adapter a second time. |
| 92 | 59 | */ |
| 93 | 60 | static int mlxcpld_mux_reg_write(struct i2c_adapter *adap, |
| 94 | − struct i2c_client *client, u8 val) | |
| 61 | + struct mlxcpld_mux *mux, u32 val) | |
| 95 | 62 | { |
| 96 | − struct mlxcpld_mux_plat_data *pdata = dev_get_platdata(&client->dev); | |
| 97 | − union i2c_smbus_data data = { .byte = val }; | |
| 98 | − | |
| 99 | − return __i2c_smbus_xfer(adap, client->addr, client->flags, | |
| 100 | − I2C_SMBUS_WRITE, pdata->sel_reg_addr, | |
| 101 | − I2C_SMBUS_BYTE_DATA, &data); | |
| 63 | + struct i2c_client *client = mux->client; | |
| 64 | + union i2c_smbus_data data; | |
| 65 | + struct i2c_msg msg; | |
| 66 | + u8 buf[3]; | |
| 67 | + | |
| 68 | + switch (mux->pdata.reg_size) { | |
| 69 | + case 1: | |
| 70 | + data.byte = val; | |
| 71 | + return __i2c_smbus_xfer(adap, client->addr, client->flags, | |
| 72 | + I2C_SMBUS_WRITE, mux->pdata.sel_reg_addr, | |
| 73 | + I2C_SMBUS_BYTE_DATA, &data); | |
| 74 | + case 2: | |
| 75 | + buf[0] = mux->pdata.sel_reg_addr >> 8; | |
| 76 | + buf[1] = mux->pdata.sel_reg_addr; | |
| 77 | + buf[2] = val; | |
| 78 | + msg.addr = client->addr; | |
| 79 | + msg.buf = buf; | |
| 80 | + msg.len = mux->pdata.reg_size + 1; | |
| 81 | + msg.flags = 0; | |
| 82 | + return __i2c_transfer(adap, &msg, 1); | |
| 83 | + default: | |
| 84 | + return -EINVAL; | |
| 85 | + } | |
| 102 | 86 | } |
| 103 | 87 | |
| 104 | 88 | static int mlxcpld_mux_select_chan(struct i2c_mux_core *muxc, u32 chan) |
| 105 | 89 | { |
| 106 | − struct mlxcpld_mux *data = i2c_mux_priv(muxc); | |
| 107 | − struct i2c_client *client = data->client; | |
| 108 | − u8 regval = chan + 1; | |
| 90 | + struct mlxcpld_mux *mux = i2c_mux_priv(muxc); | |
| 91 | + u32 regval = chan; | |
| 109 | 92 | int err = 0; |
| 110 | 93 | |
| 94 | + if (mux->pdata.reg_size == 1) | |
| 95 | + regval += 1; | |
| 96 | + | |
| 111 | 97 | /* Only select the channel if its different from the last channel */ |
| 112 | − if (data->last_chan != regval) { | |
| 113 | − err = mlxcpld_mux_reg_write(muxc->parent, client, regval); | |
| 114 | − data->last_chan = err < 0 ? 0 : regval; | |
| 98 | + if (mux->last_val != regval) { | |
| 99 | + err = mlxcpld_mux_reg_write(muxc->parent, mux, regval); | |
| 100 | + mux->last_val = err < 0 ? -1 : regval; | |
| 115 | 101 | } |
| 116 | 102 | |
| 117 | 103 | return err; |
| @@ -119,56 +105,64 @@ static int mlxcpld_mux_select_chan(struct i2c_mux_core *muxc, u32 chan) · 1 unmodified line | ||
| 119 | 105 | |
| 120 | 106 | static int mlxcpld_mux_deselect(struct i2c_mux_core *muxc, u32 chan) |
| 121 | 107 | { |
| 122 | − struct mlxcpld_mux *data = i2c_mux_priv(muxc); | |
| 123 | − struct i2c_client *client = data->client; | |
| 108 | + struct mlxcpld_mux *mux = i2c_mux_priv(muxc); | |
| 124 | 109 | |
| 125 | 110 | /* Deselect active channel */ |
| 126 | − data->last_chan = 0; | |
| 111 | + mux->last_val = -1; | |
| 127 | 112 | |
| 128 | − return mlxcpld_mux_reg_write(muxc->parent, client, data->last_chan); | |
| 113 | + return mlxcpld_mux_reg_write(muxc->parent, mux, 0); | |
| 129 | 114 | } |
| 130 | 115 | |
| 131 | 116 | /* Probe/reomove functions */ |
| 132 | −static int mlxcpld_mux_probe(struct i2c_client *client, | |
| 133 | − const struct i2c_device_id *id) | |
| 117 | +static int mlxcpld_mux_probe(struct platform_device *pdev) | |
| 134 | 118 | { |
| 135 | − struct i2c_adapter *adap = client->adapter; | |
| 136 | − struct mlxcpld_mux_plat_data *pdata = dev_get_platdata(&client->dev); | |
| 119 | + struct mlxcpld_mux_plat_data *pdata = dev_get_platdata(&pdev->dev); | |
| 120 | + struct i2c_client *client = to_i2c_client(pdev->dev.parent); | |
| 137 | 121 | struct i2c_mux_core *muxc; |
| 138 | − int num, force; | |
| 139 | 122 | struct mlxcpld_mux *data; |
| 140 | − int err; | |
| 123 | + int num, err; | |
| 124 | + u32 func; | |
| 141 | 125 | |
| 142 | 126 | if (!pdata) |
| 143 | 127 | return -EINVAL; |
| 144 | 128 | |
| 145 | − if (!i2c_check_functionality(adap, I2C_FUNC_SMBUS_WRITE_BYTE_DATA)) | |
| 129 | + switch (pdata->reg_size) { | |
| 130 | + case 1: | |
| 131 | + func = I2C_FUNC_SMBUS_WRITE_BYTE_DATA; | |
| 132 | + break; | |
| 133 | + case 2: | |
| 134 | + func = I2C_FUNC_I2C; | |
| 135 | + break; | |
| 136 | + default: | |
| 137 | + return -EINVAL; | |
| 138 | + } | |
| 139 | + | |
| 140 | + if (!i2c_check_functionality(client->adapter, func)) | |
| 146 | 141 | return -ENODEV; |
| 147 | 142 | |
| 148 | − muxc = i2c_mux_alloc(adap, &client->dev, CPLD_MUX_MAX_NCHANS, | |
| 143 | + muxc = i2c_mux_alloc(client->adapter, &pdev->dev, pdata->num_adaps, | |
| 149 | 144 | sizeof(*data), 0, mlxcpld_mux_select_chan, |
| 150 | 145 | mlxcpld_mux_deselect); |
| 151 | 146 | if (!muxc) |
| 152 | 147 | return -ENOMEM; |
| 153 | 148 | |
| 149 | + platform_set_drvdata(pdev, muxc); | |
| 154 | 150 | data = i2c_mux_priv(muxc); |
| 155 | − i2c_set_clientdata(client, muxc); | |
| 156 | 151 | data->client = client; |
| 157 | − data->last_chan = 0; /* force the first selection */ | |
| 152 | + memcpy(&data->pdata, pdata, sizeof(*pdata)); | |
| 153 | + data->last_val = -1; /* force the first selection */ | |
| 158 | 154 | |
| 159 | 155 | /* Create an adapter for each channel. */ |
| 160 | − for (num = 0; num < CPLD_MUX_MAX_NCHANS; num++) { | |
| 161 | − if (num >= pdata->num_adaps) | |
| 162 | − /* discard unconfigured channels */ | |
| 163 | − break; | |
| 164 | − | |
| 165 | − force = pdata->adap_ids[num]; | |
| 166 | − | |
| 167 | − err = i2c_mux_add_adapter(muxc, force, num, 0); | |
| 156 | + for (num = 0; num < pdata->num_adaps; num++) { | |
| 157 | + err = i2c_mux_add_adapter(muxc, 0, pdata->chan_ids[num], 0); | |
| 168 | 158 | if (err) |
| 169 | 159 | goto virt_reg_failed; |
| 170 | 160 | } |
| 171 | 161 | |
| 162 | + /* Notify caller when all channels' adapters are created. */ | |
| 163 | + if (pdata->completion_notify) | |
| 164 | + pdata->completion_notify(pdata->handle, muxc->parent, muxc->adapter); | |
| 165 | + | |
| 172 | 166 | return 0; |
| 173 | 167 | |
| 174 | 168 | virt_reg_failed: |
| @@ -176,24 +170,23 @@ virt_reg_failed: · 1 unmodified line | ||
| 176 | 170 | return err; |
| 177 | 171 | } |
| 178 | 172 | |
| 179 | −static int mlxcpld_mux_remove(struct i2c_client *client) | |
| 173 | +static int mlxcpld_mux_remove(struct platform_device *pdev) | |
| 180 | 174 | { |
| 181 | − struct i2c_mux_core *muxc = i2c_get_clientdata(client); | |
| 175 | + struct i2c_mux_core *muxc = platform_get_drvdata(pdev); | |
| 182 | 176 | |
| 183 | 177 | i2c_mux_del_adapters(muxc); |
| 184 | 178 | return 0; |
| 185 | 179 | } |
| 186 | 180 | |
| 187 | −static struct i2c_driver mlxcpld_mux_driver = { | |
| 188 | − .driver = { | |
| 189 | − .name = "mlxcpld-mux", | |
| 181 | +static struct platform_driver mlxcpld_mux_driver = { | |
| 182 | + .driver = { | |
| 183 | + .name = "i2c-mux-mlxcpld", | |
| 190 | 184 | }, |
| 191 | − .probe = mlxcpld_mux_probe, | |
| 192 | − .remove = mlxcpld_mux_remove, | |
| 193 | − .id_table = mlxcpld_mux_id, | |
| 185 | + .probe = mlxcpld_mux_probe, | |
| 186 | + .remove = mlxcpld_mux_remove, | |
| 194 | 187 | }; |
| 195 | 188 | |
| 196 | −module_i2c_driver(mlxcpld_mux_driver); | |
| 189 | +module_platform_driver(mlxcpld_mux_driver); | |
| 197 | 190 | |
| 198 | 191 | MODULE_AUTHOR("Michael Shych (michaels@mellanox.com)"); |
| 199 | 192 | MODULE_DESCRIPTION("Mellanox I2C-CPLD-MUX driver"); |
| @@ -0,0 +1,31 @@ | ||
| 1 | +/* SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0 */ | |
| 2 | +/* | |
| 3 | + * Mellanox I2C multiplexer support in CPLD | |
| 4 | + * | |
| 5 | + * Copyright (C) 2016-2020 Mellanox Technologies | |
| 6 | + */ | |
| 7 | + | |
| 8 | +#ifndef _LINUX_I2C_MLXCPLD_H | |
| 9 | +#define _LINUX_I2C_MLXCPLD_H | |
| 10 | + | |
| 11 | +/* Platform data for the CPLD I2C multiplexers */ | |
| 12 | + | |
| 13 | +/* mlxcpld_mux_plat_data - per mux data, used with i2c_register_board_info | |
| 14 | + * @chan_ids - channels array | |
| 15 | + * @num_adaps - number of adapters | |
| 16 | + * @sel_reg_addr - mux select register offset in CPLD space | |
| 17 | + * @reg_size: register size in bytes | |
| 18 | + * @handle: handle to be passed by callback | |
| 19 | + * @completion_notify: callback to notify when all the adapters are created | |
| 20 | + */ | |
| 21 | +struct mlxcpld_mux_plat_data { | |
| 22 | + int *chan_ids; | |
| 23 | + int num_adaps; | |
| 24 | + int sel_reg_addr; | |
| 25 | + u8 reg_size; | |
| 26 | + void *handle; | |
| 27 | + int (*completion_notify)(void *handle, struct i2c_adapter *parent, | |
| 28 | + struct i2c_adapter *adapters[]); | |
| 29 | +}; | |
| 30 | + | |
| 31 | +#endif /* _LINUX_I2C_MLXCPLD_H */ | |
| @@ -1,52 +0,0 @@ | ||
| 1 | −/* | |
| 2 | − * mlxcpld.h - Mellanox I2C multiplexer support in CPLD | |
| 3 | − * | |
| 4 | − * Copyright (c) 2016 Mellanox Technologies. All rights reserved. | |
| 5 | − * Copyright (c) 2016 Michael Shych <michaels@mellanox.com> | |
| 6 | − * | |
| 7 | − * Redistribution and use in source and binary forms, with or without | |
| 8 | − * modification, are permitted provided that the following conditions are met: | |
| 9 | − * | |
| 10 | − * 1. Redistributions of source code must retain the above copyright | |
| 11 | − * notice, this list of conditions and the following disclaimer. | |
| 12 | − * 2. Redistributions in binary form must reproduce the above copyright | |
| 13 | − * notice, this list of conditions and the following disclaimer in the | |
| 14 | − * documentation and/or other materials provided with the distribution. | |
| 15 | − * 3. Neither the names of the copyright holders nor the names of its | |
| 16 | − * contributors may be used to endorse or promote products derived from | |
| 17 | − * this software without specific prior written permission. | |
| 18 | − * | |
| 19 | − * Alternatively, this software may be distributed under the terms of the | |
| 20 | − * GNU General Public License ("GPL") version 2 as published by the Free | |
| 21 | − * Software Foundation. | |
| 22 | − * | |
| 23 | − * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" | |
| 24 | − * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE | |
| 25 | − * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE | |
| 26 | − * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE | |
| 27 | − * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR | |
| 28 | − * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF | |
| 29 | − * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS | |
| 30 | − * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN | |
| 31 | − * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) | |
| 32 | − * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE | |
| 33 | − * POSSIBILITY OF SUCH DAMAGE. | |
| 34 | − */ | |
| 35 | − | |
| 36 | −#ifndef _LINUX_I2C_MLXCPLD_H | |
| 37 | −#define _LINUX_I2C_MLXCPLD_H | |
| 38 | − | |
| 39 | −/* Platform data for the CPLD I2C multiplexers */ | |
| 40 | − | |
| 41 | −/* mlxcpld_mux_plat_data - per mux data, used with i2c_register_board_info | |
| 42 | − * @adap_ids - adapter array | |
| 43 | − * @num_adaps - number of adapters | |
| 44 | − * @sel_reg_addr - mux select register offset in CPLD space | |
| 45 | − */ | |
| 46 | −struct mlxcpld_mux_plat_data { | |
| 47 | − int *adap_ids; | |
| 48 | − int num_adaps; | |
| 49 | − int sel_reg_addr; | |
| 50 | −}; | |
| 51 | − | |
| 52 | −#endif /* _LINUX_I2C_MLXCPLD_H */ | |
| @@ -1,25 +1,10 @@ | ||
| 1 | 1 | /* SPDX-License-Identifier: GPL-2.0+ WITH Linux-syscall-note */ |
| 2 | 2 | /* |
| 3 | − i2c-dev.h - i2c-bus driver, char device interface | |
| 4 | − | |
| 5 | − Copyright (C) 1995-97 Simon G. Vogl | |
| 6 | − Copyright (C) 1998-99 Frodo Looijaard <frodol@dds.nl> | |
| 7 | − | |
| 8 | − This program is free software; you can redistribute it and/or modify | |
| 9 | − it under the terms of the GNU General Public License as published by | |
| 10 | − the Free Software Foundation; either version 2 of the License, or | |
| 11 | − (at your option) any later version. | |
| 12 | − | |
| 13 | − This program is distributed in the hope that it will be useful, | |
| 14 | − but WITHOUT ANY WARRANTY; without even the implied warranty of | |
| 15 | − MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
| 16 | − GNU General Public License for more details. | |
| 17 | − | |
| 18 | − You should have received a copy of the GNU General Public License | |
| 19 | − along with this program; if not, write to the Free Software | |
| 20 | − Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, | |
| 21 | − MA 02110-1301 USA. | |
| 22 | −*/ | |
| 3 | + * i2c-dev.h - I2C bus char device interface | |
| 4 | + * | |
| 5 | + * Copyright (C) 1995-97 Simon G. Vogl | |
| 6 | + * Copyright (C) 1998-99 Frodo Looijaard <frodol@dds.nl> | |
| 7 | + */ | |
| 23 | 8 | |
| 24 | 9 | #ifndef _UAPI_LINUX_I2C_DEV_H |
| 25 | 10 | #define _UAPI_LINUX_I2C_DEV_H |
| @@ -1,29 +1,11 @@ | ||
| 1 | 1 | /* SPDX-License-Identifier: GPL-2.0+ WITH Linux-syscall-note */ |
| 2 | −/* ------------------------------------------------------------------------- */ | |
| 3 | −/* */ | |
| 4 | −/* i2c.h - definitions for the i2c-bus interface */ | |
| 5 | −/* */ | |
| 6 | −/* ------------------------------------------------------------------------- */ | |
| 7 | −/* Copyright (C) 1995-2000 Simon G. Vogl | |
| 8 | − | |
| 9 | − This program is free software; you can redistribute it and/or modify | |
| 10 | − it under the terms of the GNU General Public License as published by | |
| 11 | − the Free Software Foundation; either version 2 of the License, or | |
| 12 | − (at your option) any later version. | |
| 13 | − | |
| 14 | − This program is distributed in the hope that it will be useful, | |
| 15 | − but WITHOUT ANY WARRANTY; without even the implied warranty of | |
| 16 | − MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
| 17 | − GNU General Public License for more details. | |
| 18 | − | |
| 19 | − You should have received a copy of the GNU General Public License | |
| 20 | − along with this program; if not, write to the Free Software | |
| 21 | − Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, | |
| 22 | − MA 02110-1301 USA. */ | |
| 23 | −/* ------------------------------------------------------------------------- */ | |
| 24 | − | |
| 25 | −/* With some changes from Kyösti Mälkki <kmalkki@cc.hut.fi> and | |
| 26 | − Frodo Looijaard <frodol@dds.nl> */ | |
| 2 | +/* | |
| 3 | + * i2c.h - definitions for the I2C bus interface | |
| 4 | + * | |
| 5 | + * Copyright (C) 1995-2000 Simon G. Vogl | |
| 6 | + * With some changes from Kyösti Mälkki <kmalkki@cc.hut.fi> and | |
| 7 | + * Frodo Looijaard <frodol@dds.nl> | |
| 8 | + */ | |
| 27 | 9 | |
| 28 | 10 | #ifndef _UAPI_LINUX_I2C_H |
| 29 | 11 | #define _UAPI_LINUX_I2C_H |
| @@ -32,18 +14,41 @@ · 2 unmodified lines | ||
| 32 | 14 | |
| 33 | 15 | /** |
| 34 | 16 | * struct i2c_msg - an I2C transaction segment beginning with START |
| 35 | − * @addr: Slave address, either seven or ten bits. When this is a ten | |
| 36 | − * bit address, I2C_M_TEN must be set in @flags and the adapter | |
| 37 | − * must support I2C_FUNC_10BIT_ADDR. | |
| 38 | − * @flags: I2C_M_RD is handled by all adapters. No other flags may be | |
| 39 | − * provided unless the adapter exported the relevant I2C_FUNC_* | |
| 40 | − * flags through i2c_check_functionality(). | |
| 41 | − * @len: Number of data bytes in @buf being read from or written to the | |
| 42 | − * I2C slave address. For read transactions where I2C_M_RECV_LEN | |
| 43 | − * is set, the caller guarantees that this buffer can hold up to | |
| 44 | − * 32 bytes in addition to the initial length byte sent by the | |
| 45 | − * slave (plus, if used, the SMBus PEC); and this value will be | |
| 46 | − * incremented by the number of block data bytes received. | |
| 17 | + * | |
| 18 | + * @addr: Slave address, either 7 or 10 bits. When this is a 10 bit address, | |
| 19 | + * %I2C_M_TEN must be set in @flags and the adapter must support | |
| 20 | + * %I2C_FUNC_10BIT_ADDR. | |
| 21 | + * | |
| 22 | + * @flags: | |
| 23 | + * Supported by all adapters: | |
| 24 | + * %I2C_M_RD: read data (from slave to master). Guaranteed to be 0x0001! | |
| 25 | + * | |
| 26 | + * Optional: | |
| 27 | + * %I2C_M_DMA_SAFE: the buffer of this message is DMA safe. Makes only sense | |
| 28 | + * in kernelspace, because userspace buffers are copied anyway | |
| 29 | + * | |
| 30 | + * Only if I2C_FUNC_10BIT_ADDR is set: | |
| 31 | + * %I2C_M_TEN: this is a 10 bit chip address | |
| 32 | + * | |
| 33 | + * Only if I2C_FUNC_SMBUS_READ_BLOCK_DATA is set: | |
| 34 | + * %I2C_M_RECV_LEN: message length will be first received byte | |
| 35 | + * | |
| 36 | + * Only if I2C_FUNC_NOSTART is set: | |
| 37 | + * %I2C_M_NOSTART: skip repeated start sequence | |
| 38 | + | |
| 39 | + * Only if I2C_FUNC_PROTOCOL_MANGLING is set: | |
| 40 | + * %I2C_M_NO_RD_ACK: in a read message, master ACK/NACK bit is skipped | |
| 41 | + * %I2C_M_IGNORE_NAK: treat NACK from client as ACK | |
| 42 | + * %I2C_M_REV_DIR_ADDR: toggles the Rd/Wr bit | |
| 43 | + * %I2C_M_STOP: force a STOP condition after the message | |
| 44 | + * | |
| 45 | + * @len: Number of data bytes in @buf being read from or written to the I2C | |
| 46 | + * slave address. For read transactions where %I2C_M_RECV_LEN is set, the | |
| 47 | + * caller guarantees that this buffer can hold up to %I2C_SMBUS_BLOCK_MAX | |
| 48 | + * bytes in addition to the initial length byte sent by the slave (plus, | |
| 49 | + * if used, the SMBus PEC); and this value will be incremented by the number | |
| 50 | + * of block data bytes received. | |
| 51 | + * | |
| 47 | 52 | * @buf: The buffer into which data is read, or from which it's written. |
| 48 | 53 | * |
| 49 | 54 | * An i2c_msg is the low level representation of one segment of an I2C |
| @@ -60,40 +65,36 @@ · 10 unmodified lines | ||
| 60 | 65 | * group, it is followed by a STOP. Otherwise it is followed by the next |
| 61 | 66 | * @i2c_msg transaction segment, beginning with a (repeated) START. |
| 62 | 67 | * |
| 63 | − * Alternatively, when the adapter supports I2C_FUNC_PROTOCOL_MANGLING then | |
| 68 | + * Alternatively, when the adapter supports %I2C_FUNC_PROTOCOL_MANGLING then | |
| 64 | 69 | * passing certain @flags may have changed those standard protocol behaviors. |
| 65 | 70 | * Those flags are only for use with broken/nonconforming slaves, and with |
| 66 | − * adapters which are known to support the specific mangling options they | |
| 67 | − * need (one or more of IGNORE_NAK, NO_RD_ACK, NOSTART, and REV_DIR_ADDR). | |
| 71 | + * adapters which are known to support the specific mangling options they need. | |
| 68 | 72 | */ |
| 69 | 73 | struct i2c_msg { |
| 70 | − __u16 addr; /* slave address */ | |
| 74 | + __u16 addr; | |
| 71 | 75 | __u16 flags; |
| 72 | −#define I2C_M_RD 0x0001 /* read data, from slave to master */ | |
| 73 | − /* I2C_M_RD is guaranteed to be 0x0001! */ | |
| 74 | −#define I2C_M_TEN 0x0010 /* this is a ten bit chip address */ | |
| 75 | −#define I2C_M_DMA_SAFE 0x0200 /* the buffer of this message is DMA safe */ | |
| 76 | − /* makes only sense in kernelspace */ | |
| 77 | − /* userspace buffers are copied anyway */ | |
| 78 | −#define I2C_M_RECV_LEN 0x0400 /* length will be first received byte */ | |
| 79 | −#define I2C_M_NO_RD_ACK 0x0800 /* if I2C_FUNC_PROTOCOL_MANGLING */ | |
| 80 | −#define I2C_M_IGNORE_NAK 0x1000 /* if I2C_FUNC_PROTOCOL_MANGLING */ | |
| 81 | −#define I2C_M_REV_DIR_ADDR 0x2000 /* if I2C_FUNC_PROTOCOL_MANGLING */ | |
| 82 | −#define I2C_M_NOSTART 0x4000 /* if I2C_FUNC_NOSTART */ | |
| 83 | −#define I2C_M_STOP 0x8000 /* if I2C_FUNC_PROTOCOL_MANGLING */ | |
| 84 | − __u16 len; /* msg length */ | |
| 85 | − __u8 *buf; /* pointer to msg data */ | |
| 76 | +#define I2C_M_RD 0x0001 /* guaranteed to be 0x0001! */ | |
| 77 | +#define I2C_M_TEN 0x0010 /* use only if I2C_FUNC_10BIT_ADDR */ | |
| 78 | +#define I2C_M_DMA_SAFE 0x0200 /* use only in kernel space */ | |
| 79 | +#define I2C_M_RECV_LEN 0x0400 /* use only if I2C_FUNC_SMBUS_READ_BLOCK_DATA */ | |
| 80 | +#define I2C_M_NO_RD_ACK 0x0800 /* use only if I2C_FUNC_PROTOCOL_MANGLING */ | |
| 81 | +#define I2C_M_IGNORE_NAK 0x1000 /* use only if I2C_FUNC_PROTOCOL_MANGLING */ | |
| 82 | +#define I2C_M_REV_DIR_ADDR 0x2000 /* use only if I2C_FUNC_PROTOCOL_MANGLING */ | |
| 83 | +#define I2C_M_NOSTART 0x4000 /* use only if I2C_FUNC_NOSTART */ | |
| 84 | +#define I2C_M_STOP 0x8000 /* use only if I2C_FUNC_PROTOCOL_MANGLING */ | |
| 85 | + __u16 len; | |
| 86 | + __u8 *buf; | |
| 86 | 87 | }; |
| 87 | 88 | |
| 88 | 89 | /* To determine what functionality is present */ |
| 89 | 90 | |
| 90 | 91 | #define I2C_FUNC_I2C 0x00000001 |
| 91 | −#define I2C_FUNC_10BIT_ADDR 0x00000002 | |
| 92 | −#define I2C_FUNC_PROTOCOL_MANGLING 0x00000004 /* I2C_M_IGNORE_NAK etc. */ | |
| 92 | +#define I2C_FUNC_10BIT_ADDR 0x00000002 /* required for I2C_M_TEN */ | |
| 93 | +#define I2C_FUNC_PROTOCOL_MANGLING 0x00000004 /* required for I2C_M_IGNORE_NAK etc. */ | |
| 93 | 94 | #define I2C_FUNC_SMBUS_PEC 0x00000008 |
| 94 | −#define I2C_FUNC_NOSTART 0x00000010 /* I2C_M_NOSTART */ | |
| 95 | +#define I2C_FUNC_NOSTART 0x00000010 /* required for I2C_M_NOSTART */ | |
| 95 | 96 | #define I2C_FUNC_SLAVE 0x00000020 |
| 96 | −#define I2C_FUNC_SMBUS_BLOCK_PROC_CALL 0x00008000 /* SMBus 2.0 */ | |
| 97 | +#define I2C_FUNC_SMBUS_BLOCK_PROC_CALL 0x00008000 /* SMBus 2.0 or later */ | |
| 97 | 98 | #define I2C_FUNC_SMBUS_QUICK 0x00010000 |
| 98 | 99 | #define I2C_FUNC_SMBUS_READ_BYTE 0x00020000 |
| 99 | 100 | #define I2C_FUNC_SMBUS_WRITE_BYTE 0x00040000 |
| @@ -102,11 +103,11 @@ struct i2c_msg { · 2 unmodified lines | ||
| 102 | 103 | #define I2C_FUNC_SMBUS_READ_WORD_DATA 0x00200000 |
| 103 | 104 | #define I2C_FUNC_SMBUS_WRITE_WORD_DATA 0x00400000 |
| 104 | 105 | #define I2C_FUNC_SMBUS_PROC_CALL 0x00800000 |
| 105 | −#define I2C_FUNC_SMBUS_READ_BLOCK_DATA 0x01000000 | |
| 106 | +#define I2C_FUNC_SMBUS_READ_BLOCK_DATA 0x01000000 /* required for I2C_M_RECV_LEN */ | |
| 106 | 107 | #define I2C_FUNC_SMBUS_WRITE_BLOCK_DATA 0x02000000 |
| 107 | 108 | #define I2C_FUNC_SMBUS_READ_I2C_BLOCK 0x04000000 /* I2C-like block xfer */ |
| 108 | 109 | #define I2C_FUNC_SMBUS_WRITE_I2C_BLOCK 0x08000000 /* w/ 1-byte reg. addr. */ |
| 109 | −#define I2C_FUNC_SMBUS_HOST_NOTIFY 0x10000000 | |
| 110 | +#define I2C_FUNC_SMBUS_HOST_NOTIFY 0x10000000 /* SMBus 2.0 or later */ | |
| 110 | 111 | |
| 111 | 112 | #define I2C_FUNC_SMBUS_BYTE (I2C_FUNC_SMBUS_READ_BYTE | \ |
| 112 | 113 | I2C_FUNC_SMBUS_WRITE_BYTE) |
| @@ -128,6 +129,11 @@ struct i2c_msg { · 15 unmodified lines | ||
| 128 | 129 | I2C_FUNC_SMBUS_I2C_BLOCK | \ |
| 129 | 130 | I2C_FUNC_SMBUS_PEC) |
| 130 | 131 | |
| 132 | +/* if I2C_M_RECV_LEN is also supported */ | |
| 133 | +#define I2C_FUNC_SMBUS_EMUL_ALL (I2C_FUNC_SMBUS_EMUL | \ | |
| 134 | + I2C_FUNC_SMBUS_READ_BLOCK_DATA | \ | |
| 135 | + I2C_FUNC_SMBUS_BLOCK_PROC_CALL) | |
| 136 | + | |
| 131 | 137 | /* |
| 132 | 138 | * Data for SMBus Messages |
| 133 | 139 | */ |