1c14dca07SEnric Balletbo i Serra /* 2c14dca07SEnric Balletbo i Serra * cros_ec_sensors - Driver for Chrome OS Embedded Controller sensors. 3c14dca07SEnric Balletbo i Serra * 4c14dca07SEnric Balletbo i Serra * Copyright (C) 2016 Google, Inc 5c14dca07SEnric Balletbo i Serra * 6c14dca07SEnric Balletbo i Serra * This software is licensed under the terms of the GNU General Public 7c14dca07SEnric Balletbo i Serra * License version 2, as published by the Free Software Foundation, and 8c14dca07SEnric Balletbo i Serra * may be copied, distributed, and modified under those terms. 9c14dca07SEnric Balletbo i Serra * 10c14dca07SEnric Balletbo i Serra * This program is distributed in the hope that it will be useful, 11c14dca07SEnric Balletbo i Serra * but WITHOUT ANY WARRANTY; without even the implied warranty of 12c14dca07SEnric Balletbo i Serra * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 13c14dca07SEnric Balletbo i Serra * GNU General Public License for more details. 14c14dca07SEnric Balletbo i Serra * 15c14dca07SEnric Balletbo i Serra * This driver uses the cros-ec interface to communicate with the Chrome OS 16c14dca07SEnric Balletbo i Serra * EC about sensors data. Data access is presented through iio sysfs. 17c14dca07SEnric Balletbo i Serra */ 18c14dca07SEnric Balletbo i Serra 19c14dca07SEnric Balletbo i Serra #include <linux/delay.h> 20c14dca07SEnric Balletbo i Serra #include <linux/device.h> 21c14dca07SEnric Balletbo i Serra #include <linux/iio/buffer.h> 225a0b8cb4SGwendal Grignou #include <linux/iio/common/cros_ec_sensors_core.h> 23c14dca07SEnric Balletbo i Serra #include <linux/iio/iio.h> 24c14dca07SEnric Balletbo i Serra #include <linux/iio/kfifo_buf.h> 25c14dca07SEnric Balletbo i Serra #include <linux/iio/trigger_consumer.h> 26c14dca07SEnric Balletbo i Serra #include <linux/iio/triggered_buffer.h> 27c14dca07SEnric Balletbo i Serra #include <linux/kernel.h> 28c14dca07SEnric Balletbo i Serra #include <linux/mfd/cros_ec.h> 29c14dca07SEnric Balletbo i Serra #include <linux/mfd/cros_ec_commands.h> 30c14dca07SEnric Balletbo i Serra #include <linux/module.h> 31c14dca07SEnric Balletbo i Serra #include <linux/platform_device.h> 32c14dca07SEnric Balletbo i Serra #include <linux/slab.h> 33c14dca07SEnric Balletbo i Serra #include <linux/sysfs.h> 34c14dca07SEnric Balletbo i Serra 35c14dca07SEnric Balletbo i Serra #define CROS_EC_SENSORS_MAX_CHANNELS 4 36c14dca07SEnric Balletbo i Serra 37c14dca07SEnric Balletbo i Serra /* State data for ec_sensors iio driver. */ 38c14dca07SEnric Balletbo i Serra struct cros_ec_sensors_state { 39c14dca07SEnric Balletbo i Serra /* Shared by all sensors */ 40c14dca07SEnric Balletbo i Serra struct cros_ec_sensors_core_state core; 41c14dca07SEnric Balletbo i Serra 42c14dca07SEnric Balletbo i Serra struct iio_chan_spec channels[CROS_EC_SENSORS_MAX_CHANNELS]; 43c14dca07SEnric Balletbo i Serra }; 44c14dca07SEnric Balletbo i Serra 45c14dca07SEnric Balletbo i Serra static int cros_ec_sensors_read(struct iio_dev *indio_dev, 46c14dca07SEnric Balletbo i Serra struct iio_chan_spec const *chan, 47c14dca07SEnric Balletbo i Serra int *val, int *val2, long mask) 48c14dca07SEnric Balletbo i Serra { 49c14dca07SEnric Balletbo i Serra struct cros_ec_sensors_state *st = iio_priv(indio_dev); 50c14dca07SEnric Balletbo i Serra s16 data = 0; 51c14dca07SEnric Balletbo i Serra s64 val64; 52c14dca07SEnric Balletbo i Serra int i; 535668bfddSEnric Balletbo i Serra int ret; 54c14dca07SEnric Balletbo i Serra int idx = chan->scan_index; 55c14dca07SEnric Balletbo i Serra 56c14dca07SEnric Balletbo i Serra mutex_lock(&st->core.cmd_lock); 57c14dca07SEnric Balletbo i Serra 58c14dca07SEnric Balletbo i Serra switch (mask) { 59c14dca07SEnric Balletbo i Serra case IIO_CHAN_INFO_RAW: 60c14dca07SEnric Balletbo i Serra ret = st->core.read_ec_sensors_data(indio_dev, 1 << idx, &data); 61c14dca07SEnric Balletbo i Serra if (ret < 0) 62c14dca07SEnric Balletbo i Serra break; 63a096926eSEnric Balletbo i Serra ret = IIO_VAL_INT; 64c14dca07SEnric Balletbo i Serra *val = data; 65c14dca07SEnric Balletbo i Serra break; 66c14dca07SEnric Balletbo i Serra case IIO_CHAN_INFO_CALIBBIAS: 67c14dca07SEnric Balletbo i Serra st->core.param.cmd = MOTIONSENSE_CMD_SENSOR_OFFSET; 68c14dca07SEnric Balletbo i Serra st->core.param.sensor_offset.flags = 0; 69c14dca07SEnric Balletbo i Serra 70c14dca07SEnric Balletbo i Serra ret = cros_ec_motion_send_host_cmd(&st->core, 0); 71c14dca07SEnric Balletbo i Serra if (ret < 0) 72c14dca07SEnric Balletbo i Serra break; 73c14dca07SEnric Balletbo i Serra 74c14dca07SEnric Balletbo i Serra /* Save values */ 75c14dca07SEnric Balletbo i Serra for (i = CROS_EC_SENSOR_X; i < CROS_EC_SENSOR_MAX_AXIS; i++) 76c14dca07SEnric Balletbo i Serra st->core.calib[i] = 77c14dca07SEnric Balletbo i Serra st->core.resp->sensor_offset.offset[i]; 78a096926eSEnric Balletbo i Serra ret = IIO_VAL_INT; 79c14dca07SEnric Balletbo i Serra *val = st->core.calib[idx]; 80c14dca07SEnric Balletbo i Serra break; 81c14dca07SEnric Balletbo i Serra case IIO_CHAN_INFO_SCALE: 82c14dca07SEnric Balletbo i Serra st->core.param.cmd = MOTIONSENSE_CMD_SENSOR_RANGE; 83c14dca07SEnric Balletbo i Serra st->core.param.sensor_range.data = EC_MOTION_SENSE_NO_VALUE; 84c14dca07SEnric Balletbo i Serra 85c14dca07SEnric Balletbo i Serra ret = cros_ec_motion_send_host_cmd(&st->core, 0); 86c14dca07SEnric Balletbo i Serra if (ret < 0) 87c14dca07SEnric Balletbo i Serra break; 88c14dca07SEnric Balletbo i Serra 89c14dca07SEnric Balletbo i Serra val64 = st->core.resp->sensor_range.ret; 90c14dca07SEnric Balletbo i Serra switch (st->core.type) { 91c14dca07SEnric Balletbo i Serra case MOTIONSENSE_TYPE_ACCEL: 92c14dca07SEnric Balletbo i Serra /* 93c14dca07SEnric Balletbo i Serra * EC returns data in g, iio exepects m/s^2. 94c14dca07SEnric Balletbo i Serra * Do not use IIO_G_TO_M_S_2 to avoid precision loss. 95c14dca07SEnric Balletbo i Serra */ 96c14dca07SEnric Balletbo i Serra *val = div_s64(val64 * 980665, 10); 97c14dca07SEnric Balletbo i Serra *val2 = 10000 << (CROS_EC_SENSOR_BITS - 1); 98c14dca07SEnric Balletbo i Serra ret = IIO_VAL_FRACTIONAL; 99c14dca07SEnric Balletbo i Serra break; 100c14dca07SEnric Balletbo i Serra case MOTIONSENSE_TYPE_GYRO: 101c14dca07SEnric Balletbo i Serra /* 102c14dca07SEnric Balletbo i Serra * EC returns data in dps, iio expects rad/s. 103c14dca07SEnric Balletbo i Serra * Do not use IIO_DEGREE_TO_RAD to avoid precision 104c14dca07SEnric Balletbo i Serra * loss. Round to the nearest integer. 105c14dca07SEnric Balletbo i Serra */ 106c14dca07SEnric Balletbo i Serra *val = div_s64(val64 * 314159 + 9000000ULL, 1000); 107c14dca07SEnric Balletbo i Serra *val2 = 18000 << (CROS_EC_SENSOR_BITS - 1); 108c14dca07SEnric Balletbo i Serra ret = IIO_VAL_FRACTIONAL; 109c14dca07SEnric Balletbo i Serra break; 110c14dca07SEnric Balletbo i Serra case MOTIONSENSE_TYPE_MAG: 111c14dca07SEnric Balletbo i Serra /* 112c14dca07SEnric Balletbo i Serra * EC returns data in 16LSB / uT, 113c14dca07SEnric Balletbo i Serra * iio expects Gauss 114c14dca07SEnric Balletbo i Serra */ 115c14dca07SEnric Balletbo i Serra *val = val64; 116c14dca07SEnric Balletbo i Serra *val2 = 100 << (CROS_EC_SENSOR_BITS - 1); 117c14dca07SEnric Balletbo i Serra ret = IIO_VAL_FRACTIONAL; 118c14dca07SEnric Balletbo i Serra break; 119c14dca07SEnric Balletbo i Serra default: 120c14dca07SEnric Balletbo i Serra ret = -EINVAL; 121c14dca07SEnric Balletbo i Serra } 122c14dca07SEnric Balletbo i Serra break; 123c14dca07SEnric Balletbo i Serra default: 124c14dca07SEnric Balletbo i Serra ret = cros_ec_sensors_core_read(&st->core, chan, val, val2, 125c14dca07SEnric Balletbo i Serra mask); 126c14dca07SEnric Balletbo i Serra break; 127c14dca07SEnric Balletbo i Serra } 128c14dca07SEnric Balletbo i Serra mutex_unlock(&st->core.cmd_lock); 129c14dca07SEnric Balletbo i Serra 130c14dca07SEnric Balletbo i Serra return ret; 131c14dca07SEnric Balletbo i Serra } 132c14dca07SEnric Balletbo i Serra 133c14dca07SEnric Balletbo i Serra static int cros_ec_sensors_write(struct iio_dev *indio_dev, 134c14dca07SEnric Balletbo i Serra struct iio_chan_spec const *chan, 135c14dca07SEnric Balletbo i Serra int val, int val2, long mask) 136c14dca07SEnric Balletbo i Serra { 137c14dca07SEnric Balletbo i Serra struct cros_ec_sensors_state *st = iio_priv(indio_dev); 138c14dca07SEnric Balletbo i Serra int i; 1395668bfddSEnric Balletbo i Serra int ret; 140c14dca07SEnric Balletbo i Serra int idx = chan->scan_index; 141c14dca07SEnric Balletbo i Serra 142c14dca07SEnric Balletbo i Serra mutex_lock(&st->core.cmd_lock); 143c14dca07SEnric Balletbo i Serra 144c14dca07SEnric Balletbo i Serra switch (mask) { 145c14dca07SEnric Balletbo i Serra case IIO_CHAN_INFO_CALIBBIAS: 146c14dca07SEnric Balletbo i Serra st->core.calib[idx] = val; 147c14dca07SEnric Balletbo i Serra 148c14dca07SEnric Balletbo i Serra /* Send to EC for each axis, even if not complete */ 149c14dca07SEnric Balletbo i Serra st->core.param.cmd = MOTIONSENSE_CMD_SENSOR_OFFSET; 150c14dca07SEnric Balletbo i Serra st->core.param.sensor_offset.flags = 151c14dca07SEnric Balletbo i Serra MOTION_SENSE_SET_OFFSET; 152c14dca07SEnric Balletbo i Serra for (i = CROS_EC_SENSOR_X; i < CROS_EC_SENSOR_MAX_AXIS; i++) 153c14dca07SEnric Balletbo i Serra st->core.param.sensor_offset.offset[i] = 154c14dca07SEnric Balletbo i Serra st->core.calib[i]; 155c14dca07SEnric Balletbo i Serra st->core.param.sensor_offset.temp = 156c14dca07SEnric Balletbo i Serra EC_MOTION_SENSE_INVALID_CALIB_TEMP; 157c14dca07SEnric Balletbo i Serra 158c14dca07SEnric Balletbo i Serra ret = cros_ec_motion_send_host_cmd(&st->core, 0); 159c14dca07SEnric Balletbo i Serra break; 160c14dca07SEnric Balletbo i Serra case IIO_CHAN_INFO_SCALE: 161c14dca07SEnric Balletbo i Serra if (st->core.type == MOTIONSENSE_TYPE_MAG) { 162c14dca07SEnric Balletbo i Serra ret = -EINVAL; 163c14dca07SEnric Balletbo i Serra break; 164c14dca07SEnric Balletbo i Serra } 165c14dca07SEnric Balletbo i Serra st->core.param.cmd = MOTIONSENSE_CMD_SENSOR_RANGE; 166c14dca07SEnric Balletbo i Serra st->core.param.sensor_range.data = val; 167c14dca07SEnric Balletbo i Serra 168c14dca07SEnric Balletbo i Serra /* Always roundup, so caller gets at least what it asks for. */ 169c14dca07SEnric Balletbo i Serra st->core.param.sensor_range.roundup = 1; 170c14dca07SEnric Balletbo i Serra 171c14dca07SEnric Balletbo i Serra ret = cros_ec_motion_send_host_cmd(&st->core, 0); 172c14dca07SEnric Balletbo i Serra break; 173c14dca07SEnric Balletbo i Serra default: 174c14dca07SEnric Balletbo i Serra ret = cros_ec_sensors_core_write( 175c14dca07SEnric Balletbo i Serra &st->core, chan, val, val2, mask); 176c14dca07SEnric Balletbo i Serra break; 177c14dca07SEnric Balletbo i Serra } 178c14dca07SEnric Balletbo i Serra 179c14dca07SEnric Balletbo i Serra mutex_unlock(&st->core.cmd_lock); 180c14dca07SEnric Balletbo i Serra 181c14dca07SEnric Balletbo i Serra return ret; 182c14dca07SEnric Balletbo i Serra } 183c14dca07SEnric Balletbo i Serra 184c14dca07SEnric Balletbo i Serra static const struct iio_info ec_sensors_info = { 185c14dca07SEnric Balletbo i Serra .read_raw = &cros_ec_sensors_read, 186c14dca07SEnric Balletbo i Serra .write_raw = &cros_ec_sensors_write, 187c14dca07SEnric Balletbo i Serra }; 188c14dca07SEnric Balletbo i Serra 189c14dca07SEnric Balletbo i Serra static int cros_ec_sensors_probe(struct platform_device *pdev) 190c14dca07SEnric Balletbo i Serra { 191c14dca07SEnric Balletbo i Serra struct device *dev = &pdev->dev; 192c14dca07SEnric Balletbo i Serra struct cros_ec_dev *ec_dev = dev_get_drvdata(dev->parent); 193c14dca07SEnric Balletbo i Serra struct iio_dev *indio_dev; 194c14dca07SEnric Balletbo i Serra struct cros_ec_sensors_state *state; 195c14dca07SEnric Balletbo i Serra struct iio_chan_spec *channel; 196c14dca07SEnric Balletbo i Serra int ret, i; 197c14dca07SEnric Balletbo i Serra 198c14dca07SEnric Balletbo i Serra if (!ec_dev || !ec_dev->ec_dev) { 199c14dca07SEnric Balletbo i Serra dev_warn(&pdev->dev, "No CROS EC device found.\n"); 200c14dca07SEnric Balletbo i Serra return -EINVAL; 201c14dca07SEnric Balletbo i Serra } 202c14dca07SEnric Balletbo i Serra 203c14dca07SEnric Balletbo i Serra indio_dev = devm_iio_device_alloc(&pdev->dev, sizeof(*state)); 204c14dca07SEnric Balletbo i Serra if (!indio_dev) 205c14dca07SEnric Balletbo i Serra return -ENOMEM; 206c14dca07SEnric Balletbo i Serra 207c14dca07SEnric Balletbo i Serra ret = cros_ec_sensors_core_init(pdev, indio_dev, true); 208c14dca07SEnric Balletbo i Serra if (ret) 209c14dca07SEnric Balletbo i Serra return ret; 210c14dca07SEnric Balletbo i Serra 211c14dca07SEnric Balletbo i Serra indio_dev->info = &ec_sensors_info; 212c14dca07SEnric Balletbo i Serra state = iio_priv(indio_dev); 213c14dca07SEnric Balletbo i Serra for (channel = state->channels, i = CROS_EC_SENSOR_X; 214c14dca07SEnric Balletbo i Serra i < CROS_EC_SENSOR_MAX_AXIS; i++, channel++) { 215c14dca07SEnric Balletbo i Serra /* Common part */ 216c14dca07SEnric Balletbo i Serra channel->info_mask_separate = 217c14dca07SEnric Balletbo i Serra BIT(IIO_CHAN_INFO_RAW) | 218c14dca07SEnric Balletbo i Serra BIT(IIO_CHAN_INFO_CALIBBIAS); 219c14dca07SEnric Balletbo i Serra channel->info_mask_shared_by_all = 220c14dca07SEnric Balletbo i Serra BIT(IIO_CHAN_INFO_SCALE) | 221c14dca07SEnric Balletbo i Serra BIT(IIO_CHAN_INFO_FREQUENCY) | 222c14dca07SEnric Balletbo i Serra BIT(IIO_CHAN_INFO_SAMP_FREQ); 223c14dca07SEnric Balletbo i Serra channel->scan_type.realbits = CROS_EC_SENSOR_BITS; 224c14dca07SEnric Balletbo i Serra channel->scan_type.storagebits = CROS_EC_SENSOR_BITS; 225c14dca07SEnric Balletbo i Serra channel->scan_index = i; 226c14dca07SEnric Balletbo i Serra channel->ext_info = cros_ec_sensors_ext_info; 227c14dca07SEnric Balletbo i Serra channel->modified = 1; 228c14dca07SEnric Balletbo i Serra channel->channel2 = IIO_MOD_X + i; 229c14dca07SEnric Balletbo i Serra channel->scan_type.sign = 's'; 230c14dca07SEnric Balletbo i Serra 231c14dca07SEnric Balletbo i Serra /* Sensor specific */ 232c14dca07SEnric Balletbo i Serra switch (state->core.type) { 233c14dca07SEnric Balletbo i Serra case MOTIONSENSE_TYPE_ACCEL: 234c14dca07SEnric Balletbo i Serra channel->type = IIO_ACCEL; 235c14dca07SEnric Balletbo i Serra break; 236c14dca07SEnric Balletbo i Serra case MOTIONSENSE_TYPE_GYRO: 237c14dca07SEnric Balletbo i Serra channel->type = IIO_ANGL_VEL; 238c14dca07SEnric Balletbo i Serra break; 239c14dca07SEnric Balletbo i Serra case MOTIONSENSE_TYPE_MAG: 240c14dca07SEnric Balletbo i Serra channel->type = IIO_MAGN; 241c14dca07SEnric Balletbo i Serra break; 242c14dca07SEnric Balletbo i Serra default: 243c14dca07SEnric Balletbo i Serra dev_err(&pdev->dev, "Unknown motion sensor\n"); 244c14dca07SEnric Balletbo i Serra return -EINVAL; 245c14dca07SEnric Balletbo i Serra } 246c14dca07SEnric Balletbo i Serra } 247c14dca07SEnric Balletbo i Serra 248c14dca07SEnric Balletbo i Serra /* Timestamp */ 249c14dca07SEnric Balletbo i Serra channel->type = IIO_TIMESTAMP; 250c14dca07SEnric Balletbo i Serra channel->channel = -1; 251c14dca07SEnric Balletbo i Serra channel->scan_index = CROS_EC_SENSOR_MAX_AXIS; 252c14dca07SEnric Balletbo i Serra channel->scan_type.sign = 's'; 253c14dca07SEnric Balletbo i Serra channel->scan_type.realbits = 64; 254c14dca07SEnric Balletbo i Serra channel->scan_type.storagebits = 64; 255c14dca07SEnric Balletbo i Serra 256c14dca07SEnric Balletbo i Serra indio_dev->channels = state->channels; 257c14dca07SEnric Balletbo i Serra indio_dev->num_channels = CROS_EC_SENSORS_MAX_CHANNELS; 258c14dca07SEnric Balletbo i Serra 259c14dca07SEnric Balletbo i Serra /* There is only enough room for accel and gyro in the io space */ 260c14dca07SEnric Balletbo i Serra if ((state->core.ec->cmd_readmem != NULL) && 261c14dca07SEnric Balletbo i Serra (state->core.type != MOTIONSENSE_TYPE_MAG)) 262c14dca07SEnric Balletbo i Serra state->core.read_ec_sensors_data = cros_ec_sensors_read_lpc; 263c14dca07SEnric Balletbo i Serra else 264c14dca07SEnric Balletbo i Serra state->core.read_ec_sensors_data = cros_ec_sensors_read_cmd; 265c14dca07SEnric Balletbo i Serra 266754434c4SEnric Balletbo i Serra ret = devm_iio_triggered_buffer_setup(dev, indio_dev, NULL, 267c14dca07SEnric Balletbo i Serra cros_ec_sensors_capture, NULL); 268c14dca07SEnric Balletbo i Serra if (ret) 269c14dca07SEnric Balletbo i Serra return ret; 270c14dca07SEnric Balletbo i Serra 271754434c4SEnric Balletbo i Serra return devm_iio_device_register(dev, indio_dev); 272c14dca07SEnric Balletbo i Serra } 273c14dca07SEnric Balletbo i Serra 274c14dca07SEnric Balletbo i Serra static const struct platform_device_id cros_ec_sensors_ids[] = { 275c14dca07SEnric Balletbo i Serra { 276c14dca07SEnric Balletbo i Serra .name = "cros-ec-accel", 277c14dca07SEnric Balletbo i Serra }, 278c14dca07SEnric Balletbo i Serra { 279c14dca07SEnric Balletbo i Serra .name = "cros-ec-gyro", 280c14dca07SEnric Balletbo i Serra }, 281c14dca07SEnric Balletbo i Serra { 282c14dca07SEnric Balletbo i Serra .name = "cros-ec-mag", 283c14dca07SEnric Balletbo i Serra }, 284c14dca07SEnric Balletbo i Serra { /* sentinel */ } 285c14dca07SEnric Balletbo i Serra }; 286c14dca07SEnric Balletbo i Serra MODULE_DEVICE_TABLE(platform, cros_ec_sensors_ids); 287c14dca07SEnric Balletbo i Serra 288c14dca07SEnric Balletbo i Serra static struct platform_driver cros_ec_sensors_platform_driver = { 289c14dca07SEnric Balletbo i Serra .driver = { 290c14dca07SEnric Balletbo i Serra .name = "cros-ec-sensors", 2910dad1eceSGwendal Grignou .pm = &cros_ec_sensors_pm_ops, 292c14dca07SEnric Balletbo i Serra }, 293c14dca07SEnric Balletbo i Serra .probe = cros_ec_sensors_probe, 294c14dca07SEnric Balletbo i Serra .id_table = cros_ec_sensors_ids, 295c14dca07SEnric Balletbo i Serra }; 296c14dca07SEnric Balletbo i Serra module_platform_driver(cros_ec_sensors_platform_driver); 297c14dca07SEnric Balletbo i Serra 298c14dca07SEnric Balletbo i Serra MODULE_DESCRIPTION("ChromeOS EC 3-axis sensors driver"); 299c14dca07SEnric Balletbo i Serra MODULE_LICENSE("GPL v2"); 300