Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 1 | /* |
| 2 | * intel_mid_thermal.c - Intel MID platform thermal driver |
| 3 | * |
| 4 | * Copyright (C) 2011 Intel Corporation |
| 5 | * |
| 6 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
| 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; version 2 of the License. |
| 11 | * |
| 12 | * This program is distributed in the hope that it will be useful, but |
| 13 | * WITHOUT ANY WARRANTY; without even the implied warranty of |
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| 15 | * General Public License for more details. |
| 16 | * |
| 17 | * You should have received a copy of the GNU General Public License along |
| 18 | * with this program; if not, write to the Free Software Foundation, Inc., |
| 19 | * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. |
| 20 | * |
| 21 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ |
| 22 | * Author: Durgadoss R <durgadoss.r@intel.com> |
| 23 | */ |
| 24 | |
| 25 | #define pr_fmt(fmt) "intel_mid_thermal: " fmt |
| 26 | |
| 27 | #include <linux/module.h> |
| 28 | #include <linux/init.h> |
| 29 | #include <linux/err.h> |
| 30 | #include <linux/param.h> |
| 31 | #include <linux/device.h> |
| 32 | #include <linux/platform_device.h> |
| 33 | #include <linux/slab.h> |
| 34 | #include <linux/pm.h> |
| 35 | #include <linux/thermal.h> |
| 36 | |
| 37 | #include <asm/intel_scu_ipc.h> |
| 38 | |
| 39 | /* Number of thermal sensors */ |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 40 | #define MSIC_THERMAL_SENSORS 4 |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 41 | |
| 42 | /* ADC1 - thermal registers */ |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 43 | #define MSIC_THERM_ADC1CNTL1 0x1C0 |
| 44 | #define MSIC_ADC_ENBL 0x10 |
| 45 | #define MSIC_ADC_START 0x08 |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 46 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 47 | #define MSIC_THERM_ADC1CNTL3 0x1C2 |
| 48 | #define MSIC_ADCTHERM_ENBL 0x04 |
| 49 | #define MSIC_ADCRRDATA_ENBL 0x05 |
| 50 | #define MSIC_CHANL_MASK_VAL 0x0F |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 51 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 52 | #define MSIC_STOPBIT_MASK 16 |
| 53 | #define MSIC_ADCTHERM_MASK 4 |
| 54 | /* Number of ADC channels */ |
| 55 | #define ADC_CHANLS_MAX 15 |
| 56 | #define ADC_LOOP_MAX (ADC_CHANLS_MAX - MSIC_THERMAL_SENSORS) |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 57 | |
| 58 | /* ADC channel code values */ |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 59 | #define SKIN_SENSOR0_CODE 0x08 |
| 60 | #define SKIN_SENSOR1_CODE 0x09 |
| 61 | #define SYS_SENSOR_CODE 0x0A |
| 62 | #define MSIC_DIE_SENSOR_CODE 0x03 |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 63 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 64 | #define SKIN_THERM_SENSOR0 0 |
| 65 | #define SKIN_THERM_SENSOR1 1 |
| 66 | #define SYS_THERM_SENSOR2 2 |
| 67 | #define MSIC_DIE_THERM_SENSOR3 3 |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 68 | |
| 69 | /* ADC code range */ |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 70 | #define ADC_MAX 977 |
| 71 | #define ADC_MIN 162 |
| 72 | #define ADC_VAL0C 887 |
| 73 | #define ADC_VAL20C 720 |
| 74 | #define ADC_VAL40C 508 |
| 75 | #define ADC_VAL60C 315 |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 76 | |
| 77 | /* ADC base addresses */ |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 78 | #define ADC_CHNL_START_ADDR 0x1C5 /* increments by 1 */ |
| 79 | #define ADC_DATA_START_ADDR 0x1D4 /* increments by 2 */ |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 80 | |
| 81 | /* MSIC die attributes */ |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 82 | #define MSIC_DIE_ADC_MIN 488 |
| 83 | #define MSIC_DIE_ADC_MAX 1004 |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 84 | |
| 85 | /* This holds the address of the first free ADC channel, |
| 86 | * among the 15 channels |
| 87 | */ |
| 88 | static int channel_index; |
| 89 | |
| 90 | struct platform_info { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 91 | struct platform_device *pdev; |
| 92 | struct thermal_zone_device *tzd[MSIC_THERMAL_SENSORS]; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 93 | }; |
| 94 | |
| 95 | struct thermal_device_info { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 96 | unsigned int chnl_addr; |
| 97 | int direct; |
| 98 | /* This holds the current temperature in millidegree celsius */ |
| 99 | long curr_temp; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 100 | }; |
| 101 | |
| 102 | /** |
| 103 | * to_msic_die_temp - converts adc_val to msic_die temperature |
| 104 | * @adc_val: ADC value to be converted |
| 105 | * |
| 106 | * Can sleep |
| 107 | */ |
| 108 | static int to_msic_die_temp(uint16_t adc_val) |
| 109 | { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 110 | return (368 * (adc_val) / 1000) - 220; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 111 | } |
| 112 | |
| 113 | /** |
| 114 | * is_valid_adc - checks whether the adc code is within the defined range |
| 115 | * @min: minimum value for the sensor |
| 116 | * @max: maximum value for the sensor |
| 117 | * |
| 118 | * Can sleep |
| 119 | */ |
| 120 | static int is_valid_adc(uint16_t adc_val, uint16_t min, uint16_t max) |
| 121 | { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 122 | return (adc_val >= min) && (adc_val <= max); |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 123 | } |
| 124 | |
| 125 | /** |
| 126 | * adc_to_temp - converts the ADC code to temperature in C |
| 127 | * @direct: true if ths channel is direct index |
| 128 | * @adc_val: the adc_val that needs to be converted |
| 129 | * @tp: temperature return value |
| 130 | * |
| 131 | * Linear approximation is used to covert the skin adc value into temperature. |
| 132 | * This technique is used to avoid very long look-up table to get |
| 133 | * the appropriate temp value from ADC value. |
| 134 | * The adc code vs sensor temp curve is split into five parts |
| 135 | * to achieve very close approximate temp value with less than |
| 136 | * 0.5C error |
| 137 | */ |
| 138 | static int adc_to_temp(int direct, uint16_t adc_val, unsigned long *tp) |
| 139 | { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 140 | int temp; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 141 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 142 | /* Direct conversion for die temperature */ |
| 143 | if (direct) { |
| 144 | if (is_valid_adc(adc_val, MSIC_DIE_ADC_MIN, MSIC_DIE_ADC_MAX)) { |
| 145 | *tp = to_msic_die_temp(adc_val) * 1000; |
| 146 | return 0; |
| 147 | } |
| 148 | return -ERANGE; |
| 149 | } |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 150 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 151 | if (!is_valid_adc(adc_val, ADC_MIN, ADC_MAX)) |
| 152 | return -ERANGE; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 153 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 154 | /* Linear approximation for skin temperature */ |
| 155 | if (adc_val > ADC_VAL0C) |
| 156 | temp = 177 - (adc_val/5); |
| 157 | else if ((adc_val <= ADC_VAL0C) && (adc_val > ADC_VAL20C)) |
| 158 | temp = 111 - (adc_val/8); |
| 159 | else if ((adc_val <= ADC_VAL20C) && (adc_val > ADC_VAL40C)) |
| 160 | temp = 92 - (adc_val/10); |
| 161 | else if ((adc_val <= ADC_VAL40C) && (adc_val > ADC_VAL60C)) |
| 162 | temp = 91 - (adc_val/10); |
| 163 | else |
| 164 | temp = 112 - (adc_val/6); |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 165 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 166 | /* Convert temperature in celsius to milli degree celsius */ |
| 167 | *tp = temp * 1000; |
| 168 | return 0; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 169 | } |
| 170 | |
| 171 | /** |
| 172 | * mid_read_temp - read sensors for temperature |
| 173 | * @temp: holds the current temperature for the sensor after reading |
| 174 | * |
| 175 | * reads the adc_code from the channel and converts it to real |
| 176 | * temperature. The converted value is stored in temp. |
| 177 | * |
| 178 | * Can sleep |
| 179 | */ |
| 180 | static int mid_read_temp(struct thermal_zone_device *tzd, unsigned long *temp) |
| 181 | { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 182 | struct thermal_device_info *td_info = tzd->devdata; |
| 183 | uint16_t adc_val, addr; |
| 184 | uint8_t data = 0; |
| 185 | int ret; |
| 186 | unsigned long curr_temp; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 187 | |
| 188 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 189 | addr = td_info->chnl_addr; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 190 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 191 | /* Enable the msic for conversion before reading */ |
| 192 | ret = intel_scu_ipc_iowrite8(MSIC_THERM_ADC1CNTL3, MSIC_ADCRRDATA_ENBL); |
| 193 | if (ret) |
| 194 | return ret; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 195 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 196 | /* Re-toggle the RRDATARD bit (temporary workaround) */ |
| 197 | ret = intel_scu_ipc_iowrite8(MSIC_THERM_ADC1CNTL3, MSIC_ADCTHERM_ENBL); |
| 198 | if (ret) |
| 199 | return ret; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 200 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 201 | /* Read the higher bits of data */ |
| 202 | ret = intel_scu_ipc_ioread8(addr, &data); |
| 203 | if (ret) |
| 204 | return ret; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 205 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 206 | /* Shift bits to accommodate the lower two data bits */ |
| 207 | adc_val = (data << 2); |
| 208 | addr++; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 209 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 210 | ret = intel_scu_ipc_ioread8(addr, &data);/* Read lower bits */ |
| 211 | if (ret) |
| 212 | return ret; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 213 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 214 | /* Adding lower two bits to the higher bits */ |
| 215 | data &= 03; |
| 216 | adc_val += data; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 217 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 218 | /* Convert ADC value to temperature */ |
| 219 | ret = adc_to_temp(td_info->direct, adc_val, &curr_temp); |
| 220 | if (ret == 0) |
| 221 | *temp = td_info->curr_temp = curr_temp; |
| 222 | return ret; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 223 | } |
| 224 | |
| 225 | /** |
| 226 | * configure_adc - enables/disables the ADC for conversion |
| 227 | * @val: zero: disables the ADC non-zero:enables the ADC |
| 228 | * |
| 229 | * Enable/Disable the ADC depending on the argument |
| 230 | * |
| 231 | * Can sleep |
| 232 | */ |
| 233 | static int configure_adc(int val) |
| 234 | { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 235 | int ret; |
| 236 | uint8_t data; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 237 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 238 | ret = intel_scu_ipc_ioread8(MSIC_THERM_ADC1CNTL1, &data); |
| 239 | if (ret) |
| 240 | return ret; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 241 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 242 | if (val) { |
| 243 | /* Enable and start the ADC */ |
| 244 | data |= (MSIC_ADC_ENBL | MSIC_ADC_START); |
| 245 | } else { |
| 246 | /* Just stop the ADC */ |
| 247 | data &= (~MSIC_ADC_START); |
| 248 | } |
| 249 | return intel_scu_ipc_iowrite8(MSIC_THERM_ADC1CNTL1, data); |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 250 | } |
| 251 | |
| 252 | /** |
| 253 | * set_up_therm_channel - enable thermal channel for conversion |
| 254 | * @base_addr: index of free msic ADC channel |
| 255 | * |
| 256 | * Enable all the three channels for conversion |
| 257 | * |
| 258 | * Can sleep |
| 259 | */ |
| 260 | static int set_up_therm_channel(u16 base_addr) |
| 261 | { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 262 | int ret; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 263 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 264 | /* Enable all the sensor channels */ |
| 265 | ret = intel_scu_ipc_iowrite8(base_addr, SKIN_SENSOR0_CODE); |
| 266 | if (ret) |
| 267 | return ret; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 268 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 269 | ret = intel_scu_ipc_iowrite8(base_addr + 1, SKIN_SENSOR1_CODE); |
| 270 | if (ret) |
| 271 | return ret; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 272 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 273 | ret = intel_scu_ipc_iowrite8(base_addr + 2, SYS_SENSOR_CODE); |
| 274 | if (ret) |
| 275 | return ret; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 276 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 277 | /* Since this is the last channel, set the stop bit |
| 278 | * to 1 by ORing the DIE_SENSOR_CODE with 0x10 */ |
| 279 | ret = intel_scu_ipc_iowrite8(base_addr + 3, |
| 280 | (MSIC_DIE_SENSOR_CODE | 0x10)); |
| 281 | if (ret) |
| 282 | return ret; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 283 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 284 | /* Enable ADC and start it */ |
| 285 | return configure_adc(1); |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 286 | } |
| 287 | |
| 288 | /** |
| 289 | * reset_stopbit - sets the stop bit to 0 on the given channel |
| 290 | * @addr: address of the channel |
| 291 | * |
| 292 | * Can sleep |
| 293 | */ |
| 294 | static int reset_stopbit(uint16_t addr) |
| 295 | { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 296 | int ret; |
| 297 | uint8_t data; |
| 298 | ret = intel_scu_ipc_ioread8(addr, &data); |
| 299 | if (ret) |
| 300 | return ret; |
| 301 | /* Set the stop bit to zero */ |
| 302 | return intel_scu_ipc_iowrite8(addr, (data & 0xEF)); |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 303 | } |
| 304 | |
| 305 | /** |
| 306 | * find_free_channel - finds an empty channel for conversion |
| 307 | * |
| 308 | * If the ADC is not enabled then start using 0th channel |
| 309 | * itself. Otherwise find an empty channel by looking for a |
| 310 | * channel in which the stopbit is set to 1. returns the index |
| 311 | * of the first free channel if succeeds or an error code. |
| 312 | * |
| 313 | * Context: can sleep |
| 314 | * |
| 315 | * FIXME: Ultimately the channel allocator will move into the intel_scu_ipc |
| 316 | * code. |
| 317 | */ |
| 318 | static int find_free_channel(void) |
| 319 | { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 320 | int ret; |
| 321 | int i; |
| 322 | uint8_t data; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 323 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 324 | /* check whether ADC is enabled */ |
| 325 | ret = intel_scu_ipc_ioread8(MSIC_THERM_ADC1CNTL1, &data); |
| 326 | if (ret) |
| 327 | return ret; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 328 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 329 | if ((data & MSIC_ADC_ENBL) == 0) |
| 330 | return 0; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 331 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 332 | /* ADC is already enabled; Looking for an empty channel */ |
| 333 | for (i = 0; i < ADC_CHANLS_MAX; i++) { |
| 334 | ret = intel_scu_ipc_ioread8(ADC_CHNL_START_ADDR + i, &data); |
| 335 | if (ret) |
| 336 | return ret; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 337 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 338 | if (data & MSIC_STOPBIT_MASK) { |
| 339 | ret = i; |
| 340 | break; |
| 341 | } |
| 342 | } |
| 343 | return (ret > ADC_LOOP_MAX) ? (-EINVAL) : ret; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 344 | } |
| 345 | |
| 346 | /** |
| 347 | * mid_initialize_adc - initializing the ADC |
| 348 | * @dev: our device structure |
| 349 | * |
| 350 | * Initialize the ADC for reading thermistor values. Can sleep. |
| 351 | */ |
| 352 | static int mid_initialize_adc(struct device *dev) |
| 353 | { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 354 | u8 data; |
| 355 | u16 base_addr; |
| 356 | int ret; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 357 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 358 | /* |
| 359 | * Ensure that adctherm is disabled before we |
| 360 | * initialize the ADC |
| 361 | */ |
| 362 | ret = intel_scu_ipc_ioread8(MSIC_THERM_ADC1CNTL3, &data); |
| 363 | if (ret) |
| 364 | return ret; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 365 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 366 | if (data & MSIC_ADCTHERM_MASK) |
| 367 | dev_warn(dev, "ADCTHERM already set"); |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 368 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 369 | /* Index of the first channel in which the stop bit is set */ |
| 370 | channel_index = find_free_channel(); |
| 371 | if (channel_index < 0) { |
| 372 | dev_err(dev, "No free ADC channels"); |
| 373 | return channel_index; |
| 374 | } |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 375 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 376 | base_addr = ADC_CHNL_START_ADDR + channel_index; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 377 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 378 | if (!(channel_index == 0 || channel_index == ADC_LOOP_MAX)) { |
| 379 | /* Reset stop bit for channels other than 0 and 12 */ |
| 380 | ret = reset_stopbit(base_addr); |
| 381 | if (ret) |
| 382 | return ret; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 383 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 384 | /* Index of the first free channel */ |
| 385 | base_addr++; |
| 386 | channel_index++; |
| 387 | } |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 388 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 389 | ret = set_up_therm_channel(base_addr); |
| 390 | if (ret) { |
| 391 | dev_err(dev, "unable to enable ADC"); |
| 392 | return ret; |
| 393 | } |
| 394 | dev_dbg(dev, "ADC initialization successful"); |
| 395 | return ret; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 396 | } |
| 397 | |
| 398 | /** |
| 399 | * initialize_sensor - sets default temp and timer ranges |
| 400 | * @index: index of the sensor |
| 401 | * |
| 402 | * Context: can sleep |
| 403 | */ |
| 404 | static struct thermal_device_info *initialize_sensor(int index) |
| 405 | { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 406 | struct thermal_device_info *td_info = |
| 407 | kzalloc(sizeof(struct thermal_device_info), GFP_KERNEL); |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 408 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 409 | if (!td_info) |
| 410 | return NULL; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 411 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 412 | /* Set the base addr of the channel for this sensor */ |
| 413 | td_info->chnl_addr = ADC_DATA_START_ADDR + 2 * (channel_index + index); |
| 414 | /* Sensor 3 is direct conversion */ |
| 415 | if (index == 3) |
| 416 | td_info->direct = 1; |
| 417 | return td_info; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 418 | } |
| 419 | |
| 420 | /** |
| 421 | * mid_thermal_resume - resume routine |
| 422 | * @pdev: platform device structure |
| 423 | * |
| 424 | * mid thermal resume: re-initializes the adc. Can sleep. |
| 425 | */ |
| 426 | static int mid_thermal_resume(struct platform_device *pdev) |
| 427 | { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 428 | return mid_initialize_adc(&pdev->dev); |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 429 | } |
| 430 | |
| 431 | /** |
| 432 | * mid_thermal_suspend - suspend routine |
| 433 | * @pdev: platform device structure |
| 434 | * |
| 435 | * mid thermal suspend implements the suspend functionality |
| 436 | * by stopping the ADC. Can sleep. |
| 437 | */ |
| 438 | static int mid_thermal_suspend(struct platform_device *pdev, pm_message_t mesg) |
| 439 | { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 440 | /* |
| 441 | * This just stops the ADC and does not disable it. |
| 442 | * temporary workaround until we have a generic ADC driver. |
| 443 | * If 0 is passed, it disables the ADC. |
| 444 | */ |
| 445 | return configure_adc(0); |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 446 | } |
| 447 | |
| 448 | /** |
| 449 | * read_curr_temp - reads the current temperature and stores in temp |
| 450 | * @temp: holds the current temperature value after reading |
| 451 | * |
| 452 | * Can sleep |
| 453 | */ |
| 454 | static int read_curr_temp(struct thermal_zone_device *tzd, unsigned long *temp) |
| 455 | { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 456 | WARN_ON(tzd == NULL); |
| 457 | return mid_read_temp(tzd, temp); |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 458 | } |
| 459 | |
| 460 | /* Can't be const */ |
| 461 | static struct thermal_zone_device_ops tzd_ops = { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 462 | .get_temp = read_curr_temp, |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 463 | }; |
| 464 | |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 465 | /** |
| 466 | * mid_thermal_probe - mfld thermal initialize |
| 467 | * @pdev: platform device structure |
| 468 | * |
| 469 | * mid thermal probe initializes the hardware and registers |
| 470 | * all the sensors with the generic thermal framework. Can sleep. |
| 471 | */ |
| 472 | static int mid_thermal_probe(struct platform_device *pdev) |
| 473 | { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 474 | static char *name[MSIC_THERMAL_SENSORS] = { |
| 475 | "skin0", "skin1", "sys", "msicdie" |
| 476 | }; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 477 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 478 | int ret; |
| 479 | int i; |
| 480 | struct platform_info *pinfo; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 481 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 482 | pinfo = kzalloc(sizeof(struct platform_info), GFP_KERNEL); |
| 483 | if (!pinfo) |
| 484 | return -ENOMEM; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 485 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 486 | /* Initializing the hardware */ |
| 487 | ret = mid_initialize_adc(&pdev->dev); |
| 488 | if (ret) { |
| 489 | dev_err(&pdev->dev, "ADC init failed"); |
| 490 | kfree(pinfo); |
| 491 | return ret; |
| 492 | } |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 493 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 494 | /* Register each sensor with the generic thermal framework*/ |
| 495 | for (i = 0; i < MSIC_THERMAL_SENSORS; i++) { |
Axel Lin | 03f8952 | 2011-07-06 23:40:51 +0800 | [diff] [blame] | 496 | struct thermal_device_info *td_info = initialize_sensor(i); |
| 497 | |
| 498 | if (!td_info) { |
| 499 | ret = -ENOMEM; |
| 500 | goto err; |
| 501 | } |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 502 | pinfo->tzd[i] = thermal_zone_device_register(name[i], |
Axel Lin | 03f8952 | 2011-07-06 23:40:51 +0800 | [diff] [blame] | 503 | 0, td_info, &tzd_ops, 0, 0, 0, 0); |
| 504 | if (IS_ERR(pinfo->tzd[i])) { |
| 505 | kfree(td_info); |
| 506 | ret = PTR_ERR(pinfo->tzd[i]); |
| 507 | goto err; |
| 508 | } |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 509 | } |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 510 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 511 | pinfo->pdev = pdev; |
| 512 | platform_set_drvdata(pdev, pinfo); |
| 513 | return 0; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 514 | |
Axel Lin | 03f8952 | 2011-07-06 23:40:51 +0800 | [diff] [blame] | 515 | err: |
| 516 | while (--i >= 0) { |
| 517 | kfree(pinfo->tzd[i]->devdata); |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 518 | thermal_zone_device_unregister(pinfo->tzd[i]); |
Axel Lin | 03f8952 | 2011-07-06 23:40:51 +0800 | [diff] [blame] | 519 | } |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 520 | configure_adc(0); |
| 521 | kfree(pinfo); |
| 522 | return ret; |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 523 | } |
| 524 | |
| 525 | /** |
| 526 | * mid_thermal_remove - mfld thermal finalize |
| 527 | * @dev: platform device structure |
| 528 | * |
| 529 | * MLFD thermal remove unregisters all the sensors from the generic |
| 530 | * thermal framework. Can sleep. |
| 531 | */ |
| 532 | static int mid_thermal_remove(struct platform_device *pdev) |
| 533 | { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 534 | int i; |
| 535 | struct platform_info *pinfo = platform_get_drvdata(pdev); |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 536 | |
Axel Lin | 03f8952 | 2011-07-06 23:40:51 +0800 | [diff] [blame] | 537 | for (i = 0; i < MSIC_THERMAL_SENSORS; i++) { |
| 538 | kfree(pinfo->tzd[i]->devdata); |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 539 | thermal_zone_device_unregister(pinfo->tzd[i]); |
Axel Lin | 03f8952 | 2011-07-06 23:40:51 +0800 | [diff] [blame] | 540 | } |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 541 | |
Ameya Palande | 239dca9 | 2011-04-07 16:30:02 +0300 | [diff] [blame] | 542 | kfree(pinfo); |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 543 | platform_set_drvdata(pdev, NULL); |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 544 | |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 545 | /* Stop the ADC */ |
| 546 | return configure_adc(0); |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 547 | } |
| 548 | |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 549 | #define DRIVER_NAME "msic_sensor" |
| 550 | |
| 551 | static const struct platform_device_id therm_id_table[] = { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 552 | { DRIVER_NAME, 1 }, |
| 553 | { } |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 554 | }; |
| 555 | |
| 556 | static struct platform_driver mid_thermal_driver = { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 557 | .driver = { |
| 558 | .name = DRIVER_NAME, |
| 559 | .owner = THIS_MODULE, |
| 560 | }, |
| 561 | .probe = mid_thermal_probe, |
| 562 | .suspend = mid_thermal_suspend, |
| 563 | .resume = mid_thermal_resume, |
| 564 | .remove = __devexit_p(mid_thermal_remove), |
| 565 | .id_table = therm_id_table, |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 566 | }; |
| 567 | |
| 568 | static int __init mid_thermal_module_init(void) |
| 569 | { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 570 | return platform_driver_register(&mid_thermal_driver); |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 571 | } |
| 572 | |
| 573 | static void __exit mid_thermal_module_exit(void) |
| 574 | { |
Ameya Palande | 253a006 | 2011-04-01 16:54:11 +0300 | [diff] [blame] | 575 | platform_driver_unregister(&mid_thermal_driver); |
Durgadoss R | f017fbe | 2011-02-20 23:05:43 +0530 | [diff] [blame] | 576 | } |
| 577 | |
| 578 | module_init(mid_thermal_module_init); |
| 579 | module_exit(mid_thermal_module_exit); |
| 580 | |
| 581 | MODULE_AUTHOR("Durgadoss R <durgadoss.r@intel.com>"); |
| 582 | MODULE_DESCRIPTION("Intel Medfield Platform Thermal Driver"); |
| 583 | MODULE_LICENSE("GPL"); |