^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * DRV2667 haptics driver family
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Author: Dan Murphy <dmurphy@ti.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * Copyright: (C) 2014 Texas Instruments, Inc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/i2c.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/input.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/regmap.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/regulator/consumer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) /* Contol registers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #define DRV2667_STATUS 0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #define DRV2667_CTRL_1 0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #define DRV2667_CTRL_2 0x02
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) /* Waveform sequencer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #define DRV2667_WV_SEQ_0 0x03
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #define DRV2667_WV_SEQ_1 0x04
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #define DRV2667_WV_SEQ_2 0x05
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #define DRV2667_WV_SEQ_3 0x06
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #define DRV2667_WV_SEQ_4 0x07
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #define DRV2667_WV_SEQ_5 0x08
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #define DRV2667_WV_SEQ_6 0x09
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #define DRV2667_WV_SEQ_7 0x0A
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) #define DRV2667_FIFO 0x0B
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #define DRV2667_PAGE 0xFF
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #define DRV2667_MAX_REG DRV2667_PAGE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define DRV2667_PAGE_0 0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #define DRV2667_PAGE_1 0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) #define DRV2667_PAGE_2 0x02
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #define DRV2667_PAGE_3 0x03
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define DRV2667_PAGE_4 0x04
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) #define DRV2667_PAGE_5 0x05
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) #define DRV2667_PAGE_6 0x06
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #define DRV2667_PAGE_7 0x07
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) #define DRV2667_PAGE_8 0x08
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) /* RAM fields */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) #define DRV2667_RAM_HDR_SZ 0x0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) /* RAM Header addresses */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) #define DRV2667_RAM_START_HI 0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) #define DRV2667_RAM_START_LO 0x02
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) #define DRV2667_RAM_STOP_HI 0x03
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) #define DRV2667_RAM_STOP_LO 0x04
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) #define DRV2667_RAM_REPEAT_CT 0x05
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) /* RAM data addresses */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) #define DRV2667_RAM_AMP 0x06
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) #define DRV2667_RAM_FREQ 0x07
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) #define DRV2667_RAM_DURATION 0x08
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) #define DRV2667_RAM_ENVELOPE 0x09
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) /* Control 1 Register */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) #define DRV2667_25_VPP_GAIN 0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) #define DRV2667_50_VPP_GAIN 0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) #define DRV2667_75_VPP_GAIN 0x02
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) #define DRV2667_100_VPP_GAIN 0x03
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) #define DRV2667_DIGITAL_IN 0xfc
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) #define DRV2667_ANALOG_IN (1 << 2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) /* Control 2 Register */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) #define DRV2667_GO (1 << 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) #define DRV2667_STANDBY (1 << 6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) #define DRV2667_DEV_RST (1 << 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) /* RAM Envelope settings */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) #define DRV2667_NO_ENV 0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) #define DRV2667_32_MS_ENV 0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) #define DRV2667_64_MS_ENV 0x02
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) #define DRV2667_96_MS_ENV 0x03
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) #define DRV2667_128_MS_ENV 0x04
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) #define DRV2667_160_MS_ENV 0x05
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) #define DRV2667_192_MS_ENV 0x06
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) #define DRV2667_224_MS_ENV 0x07
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) #define DRV2667_256_MS_ENV 0x08
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) #define DRV2667_512_MS_ENV 0x09
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) #define DRV2667_768_MS_ENV 0x0a
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) #define DRV2667_1024_MS_ENV 0x0b
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) #define DRV2667_1280_MS_ENV 0x0c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) #define DRV2667_1536_MS_ENV 0x0d
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) #define DRV2667_1792_MS_ENV 0x0e
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) #define DRV2667_2048_MS_ENV 0x0f
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) * struct drv2667_data -
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) * @input_dev - Pointer to the input device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) * @client - Pointer to the I2C client
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) * @regmap - Register map of the device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) * @work - Work item used to off load the enable/disable of the vibration
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) * @regulator - Pointer to the regulator for the IC
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) * @magnitude - Magnitude of the vibration event
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) **/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) struct drv2667_data {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) struct input_dev *input_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) struct i2c_client *client;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) struct regmap *regmap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) struct work_struct work;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) struct regulator *regulator;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) u32 page;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) u32 magnitude;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) u32 frequency;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) static const struct reg_default drv2667_reg_defs[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) { DRV2667_STATUS, 0x02 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) { DRV2667_CTRL_1, 0x28 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) { DRV2667_CTRL_2, 0x40 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) { DRV2667_WV_SEQ_0, 0x00 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) { DRV2667_WV_SEQ_1, 0x00 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) { DRV2667_WV_SEQ_2, 0x00 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) { DRV2667_WV_SEQ_3, 0x00 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) { DRV2667_WV_SEQ_4, 0x00 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) { DRV2667_WV_SEQ_5, 0x00 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) { DRV2667_WV_SEQ_6, 0x00 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) { DRV2667_WV_SEQ_7, 0x00 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) { DRV2667_FIFO, 0x00 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) { DRV2667_PAGE, 0x00 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) static int drv2667_set_waveform_freq(struct drv2667_data *haptics)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) unsigned int read_buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) int freq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) /* Per the data sheet:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) * Sinusoid Frequency (Hz) = 7.8125 x Frequency
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) freq = (haptics->frequency * 1000) / 78125;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) if (freq <= 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) dev_err(&haptics->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) "ERROR: Frequency calculated to %i\n", freq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) error = regmap_read(haptics->regmap, DRV2667_PAGE, &read_buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) dev_err(&haptics->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) "Failed to read the page number: %d\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) if (read_buf == DRV2667_PAGE_0 ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) haptics->page != read_buf) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) error = regmap_write(haptics->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) DRV2667_PAGE, haptics->page);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) dev_err(&haptics->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) "Failed to set the page: %d\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) error = regmap_write(haptics->regmap, DRV2667_RAM_FREQ, freq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) dev_err(&haptics->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) "Failed to set the frequency: %d\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) /* Reset back to original page */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) if (read_buf == DRV2667_PAGE_0 ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) haptics->page != read_buf) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) error = regmap_write(haptics->regmap, DRV2667_PAGE, read_buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) dev_err(&haptics->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) "Failed to set the page: %d\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) return -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) static void drv2667_worker(struct work_struct *work)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) struct drv2667_data *haptics = container_of(work, struct drv2667_data, work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) if (haptics->magnitude) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) error = regmap_write(haptics->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) DRV2667_PAGE, haptics->page);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) dev_err(&haptics->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) "Failed to set the page: %d\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) error = regmap_write(haptics->regmap, DRV2667_RAM_AMP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) haptics->magnitude);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) dev_err(&haptics->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) "Failed to set the amplitude: %d\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) error = regmap_write(haptics->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) DRV2667_PAGE, DRV2667_PAGE_0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) dev_err(&haptics->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) "Failed to set the page: %d\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) error = regmap_write(haptics->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) DRV2667_CTRL_2, DRV2667_GO);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) dev_err(&haptics->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) "Failed to set the GO bit: %d\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) error = regmap_update_bits(haptics->regmap, DRV2667_CTRL_2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) DRV2667_GO, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) dev_err(&haptics->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) "Failed to unset the GO bit: %d\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) static int drv2667_haptics_play(struct input_dev *input, void *data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) struct ff_effect *effect)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) struct drv2667_data *haptics = input_get_drvdata(input);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) if (effect->u.rumble.strong_magnitude > 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) haptics->magnitude = effect->u.rumble.strong_magnitude;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) else if (effect->u.rumble.weak_magnitude > 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) haptics->magnitude = effect->u.rumble.weak_magnitude;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) haptics->magnitude = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) schedule_work(&haptics->work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) static void drv2667_close(struct input_dev *input)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) struct drv2667_data *haptics = input_get_drvdata(input);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) cancel_work_sync(&haptics->work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) error = regmap_update_bits(haptics->regmap, DRV2667_CTRL_2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) DRV2667_STANDBY, DRV2667_STANDBY);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) dev_err(&haptics->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) "Failed to enter standby mode: %d\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) static const struct reg_sequence drv2667_init_regs[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) { DRV2667_CTRL_2, 0 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) { DRV2667_CTRL_1, DRV2667_25_VPP_GAIN },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) { DRV2667_WV_SEQ_0, 1 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) { DRV2667_WV_SEQ_1, 0 }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) static const struct reg_sequence drv2667_page1_init[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) { DRV2667_RAM_HDR_SZ, 0x05 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) { DRV2667_RAM_START_HI, 0x80 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) { DRV2667_RAM_START_LO, 0x06 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) { DRV2667_RAM_STOP_HI, 0x00 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) { DRV2667_RAM_STOP_LO, 0x09 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) { DRV2667_RAM_REPEAT_CT, 0 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) { DRV2667_RAM_DURATION, 0x05 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) { DRV2667_RAM_ENVELOPE, DRV2667_NO_ENV },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) { DRV2667_RAM_AMP, 0x60 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) static int drv2667_init(struct drv2667_data *haptics)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) /* Set default haptic frequency to 195Hz on Page 1*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) haptics->frequency = 195;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) haptics->page = DRV2667_PAGE_1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) error = regmap_register_patch(haptics->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) drv2667_init_regs,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) ARRAY_SIZE(drv2667_init_regs));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) dev_err(&haptics->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) "Failed to write init registers: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) error = regmap_write(haptics->regmap, DRV2667_PAGE, haptics->page);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) dev_err(&haptics->client->dev, "Failed to set page: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) goto error_out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) error = drv2667_set_waveform_freq(haptics);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) goto error_page;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) error = regmap_register_patch(haptics->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) drv2667_page1_init,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) ARRAY_SIZE(drv2667_page1_init));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) dev_err(&haptics->client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) "Failed to write page registers: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) error = regmap_write(haptics->regmap, DRV2667_PAGE, DRV2667_PAGE_0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) error_page:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) regmap_write(haptics->regmap, DRV2667_PAGE, DRV2667_PAGE_0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) error_out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) static const struct regmap_config drv2667_regmap_config = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) .reg_bits = 8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) .val_bits = 8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) .max_register = DRV2667_MAX_REG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) .reg_defaults = drv2667_reg_defs,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) .num_reg_defaults = ARRAY_SIZE(drv2667_reg_defs),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) .cache_type = REGCACHE_NONE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) static int drv2667_probe(struct i2c_client *client,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) const struct i2c_device_id *id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) struct drv2667_data *haptics;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) haptics = devm_kzalloc(&client->dev, sizeof(*haptics), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) if (!haptics)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) haptics->regulator = devm_regulator_get(&client->dev, "vbat");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) if (IS_ERR(haptics->regulator)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) error = PTR_ERR(haptics->regulator);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) dev_err(&client->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) "unable to get regulator, error: %d\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) haptics->input_dev = devm_input_allocate_device(&client->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) if (!haptics->input_dev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) dev_err(&client->dev, "Failed to allocate input device\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) haptics->input_dev->name = "drv2667:haptics";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) haptics->input_dev->dev.parent = client->dev.parent;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) haptics->input_dev->close = drv2667_close;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) input_set_drvdata(haptics->input_dev, haptics);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) input_set_capability(haptics->input_dev, EV_FF, FF_RUMBLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) error = input_ff_create_memless(haptics->input_dev, NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) drv2667_haptics_play);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) dev_err(&client->dev, "input_ff_create() failed: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) INIT_WORK(&haptics->work, drv2667_worker);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) haptics->client = client;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) i2c_set_clientdata(client, haptics);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) haptics->regmap = devm_regmap_init_i2c(client, &drv2667_regmap_config);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) if (IS_ERR(haptics->regmap)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) error = PTR_ERR(haptics->regmap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) dev_err(&client->dev, "Failed to allocate register map: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) error = drv2667_init(haptics);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) dev_err(&client->dev, "Device init failed: %d\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) error = input_register_device(haptics->input_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) dev_err(&client->dev, "couldn't register input device: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) static int __maybe_unused drv2667_suspend(struct device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) struct drv2667_data *haptics = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) mutex_lock(&haptics->input_dev->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) if (haptics->input_dev->users) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) ret = regmap_update_bits(haptics->regmap, DRV2667_CTRL_2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) DRV2667_STANDBY, DRV2667_STANDBY);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) dev_err(dev, "Failed to set standby mode\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) regulator_disable(haptics->regulator);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) ret = regulator_disable(haptics->regulator);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) dev_err(dev, "Failed to disable regulator\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) regmap_update_bits(haptics->regmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) DRV2667_CTRL_2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) DRV2667_STANDBY, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) mutex_unlock(&haptics->input_dev->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) static int __maybe_unused drv2667_resume(struct device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) struct drv2667_data *haptics = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) mutex_lock(&haptics->input_dev->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) if (haptics->input_dev->users) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) ret = regulator_enable(haptics->regulator);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) dev_err(dev, "Failed to enable regulator\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) ret = regmap_update_bits(haptics->regmap, DRV2667_CTRL_2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) DRV2667_STANDBY, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) dev_err(dev, "Failed to unset standby mode\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) regulator_disable(haptics->regulator);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) mutex_unlock(&haptics->input_dev->mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) static SIMPLE_DEV_PM_OPS(drv2667_pm_ops, drv2667_suspend, drv2667_resume);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) static const struct i2c_device_id drv2667_id[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) { "drv2667", 0 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) { }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) MODULE_DEVICE_TABLE(i2c, drv2667_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) #ifdef CONFIG_OF
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) static const struct of_device_id drv2667_of_match[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) { .compatible = "ti,drv2667", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) { }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) MODULE_DEVICE_TABLE(of, drv2667_of_match);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) static struct i2c_driver drv2667_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) .probe = drv2667_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) .name = "drv2667-haptics",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) .of_match_table = of_match_ptr(drv2667_of_match),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) .pm = &drv2667_pm_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) .id_table = drv2667_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) module_i2c_driver(drv2667_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) MODULE_DESCRIPTION("TI DRV2667 haptics driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) MODULE_AUTHOR("Dan Murphy <dmurphy@ti.com>");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags
| Donate