^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Nokia RX-51 battery driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (C) 2012 Pali Rohár <pali@kernel.org>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/param.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/power_supply.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/iio/consumer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) struct rx51_device_info {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) struct device *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) struct power_supply *bat;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) struct power_supply_desc bat_desc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) struct iio_channel *channel_temp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) struct iio_channel *channel_bsi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) struct iio_channel *channel_vbat;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) * Read ADCIN channel value, code copied from maemo kernel
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) static int rx51_battery_read_adc(struct iio_channel *channel)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) int val, err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) err = iio_read_channel_average_raw(channel, &val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) return val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) * Read ADCIN channel 12 (voltage) and convert RAW value to micro voltage
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) * This conversion formula was extracted from maemo program bsi-read
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) static int rx51_battery_read_voltage(struct rx51_device_info *di)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) int voltage = rx51_battery_read_adc(di->channel_vbat);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) if (voltage < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) dev_err(di->dev, "Could not read ADC: %d\n", voltage);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) return voltage;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) return 1000 * (10000 * voltage / 1705);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) * Temperature look-up tables
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) * TEMP = (1/(t1 + 1/298) - 273.15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) * Where t1 = (1/B) * ln((RAW_ADC_U * 2.5)/(R * I * 255))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) * Formula is based on experimental data, RX-51 CAL data, maemo program bme
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) * and formula from da9052 driver with values R = 100, B = 3380, I = 0.00671
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) * Table1 (temperature for first 25 RAW values)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) * Usage: TEMP = rx51_temp_table1[RAW]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) * RAW is between 1 and 24
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) * TEMP is between 201 C and 55 C
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) static u8 rx51_temp_table1[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) 255, 201, 159, 138, 124, 114, 106, 99, 94, 89, 85, 82, 78, 75,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) 73, 70, 68, 66, 64, 62, 61, 59, 57, 56, 55
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) * Table2 (lowest RAW value for temperature)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) * Usage: RAW = rx51_temp_table2[TEMP-rx51_temp_table2_first]
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) * TEMP is between 53 C and -32 C
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) * RAW is between 25 and 993
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) #define rx51_temp_table2_first 53
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) static u16 rx51_temp_table2[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) 25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 39,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) 40, 41, 43, 44, 46, 48, 49, 51, 53, 55, 57, 59, 61, 64,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) 66, 69, 71, 74, 77, 80, 83, 86, 90, 94, 97, 101, 106, 110,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) 115, 119, 125, 130, 136, 141, 148, 154, 161, 168, 176, 184, 202, 211,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) 221, 231, 242, 254, 266, 279, 293, 308, 323, 340, 357, 375, 395, 415,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) 437, 460, 485, 511, 539, 568, 600, 633, 669, 706, 747, 790, 836, 885,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) 937, 993, 1024
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) * Read ADCIN channel 0 (battery temp) and convert value to tenths of Celsius
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) * Use Temperature look-up tables for conversation
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) static int rx51_battery_read_temperature(struct rx51_device_info *di)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) int min = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) int max = ARRAY_SIZE(rx51_temp_table2) - 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) int raw = rx51_battery_read_adc(di->channel_temp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) if (raw < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) dev_err(di->dev, "Could not read ADC: %d\n", raw);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) /* Zero and negative values are undefined */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) if (raw <= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) return INT_MAX;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) /* ADC channels are 10 bit, higher value are undefined */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) if (raw >= (1 << 10))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) return INT_MIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) /* First check for temperature in first direct table */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) if (raw < ARRAY_SIZE(rx51_temp_table1))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) return rx51_temp_table1[raw] * 10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) /* Binary search RAW value in second inverse table */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) while (max - min > 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) int mid = (max + min) / 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) if (rx51_temp_table2[mid] <= raw)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) min = mid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) else if (rx51_temp_table2[mid] > raw)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) max = mid;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) if (rx51_temp_table2[mid] == raw)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) return (rx51_temp_table2_first - min) * 10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) * Read ADCIN channel 4 (BSI) and convert RAW value to micro Ah
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) * This conversion formula was extracted from maemo program bsi-read
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) static int rx51_battery_read_capacity(struct rx51_device_info *di)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) int capacity = rx51_battery_read_adc(di->channel_bsi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) if (capacity < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) dev_err(di->dev, "Could not read ADC: %d\n", capacity);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) return capacity;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) return 1280 * (1200 * capacity)/(1024 - capacity);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) * Return power_supply property
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) static int rx51_battery_get_property(struct power_supply *psy,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) enum power_supply_property psp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) union power_supply_propval *val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) struct rx51_device_info *di = power_supply_get_drvdata(psy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) switch (psp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) case POWER_SUPPLY_PROP_TECHNOLOGY:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) val->intval = 4200000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) case POWER_SUPPLY_PROP_PRESENT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) val->intval = rx51_battery_read_voltage(di) ? 1 : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) case POWER_SUPPLY_PROP_VOLTAGE_NOW:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) val->intval = rx51_battery_read_voltage(di);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) case POWER_SUPPLY_PROP_TEMP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) val->intval = rx51_battery_read_temperature(di);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) val->intval = rx51_battery_read_capacity(di);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) return -EINVAL;
^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) if (val->intval == INT_MAX || val->intval == INT_MIN)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) static enum power_supply_property rx51_battery_props[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) POWER_SUPPLY_PROP_TECHNOLOGY,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) POWER_SUPPLY_PROP_PRESENT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) POWER_SUPPLY_PROP_VOLTAGE_NOW,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) POWER_SUPPLY_PROP_TEMP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) static int rx51_battery_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) struct power_supply_config psy_cfg = {};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) struct rx51_device_info *di;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) di = devm_kzalloc(&pdev->dev, sizeof(*di), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) if (!di)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) platform_set_drvdata(pdev, di);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) di->dev = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) di->bat_desc.name = "rx51-battery";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) di->bat_desc.type = POWER_SUPPLY_TYPE_BATTERY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) di->bat_desc.properties = rx51_battery_props;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) di->bat_desc.num_properties = ARRAY_SIZE(rx51_battery_props);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) di->bat_desc.get_property = rx51_battery_get_property;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) psy_cfg.drv_data = di;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) di->channel_temp = iio_channel_get(di->dev, "temp");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) if (IS_ERR(di->channel_temp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) ret = PTR_ERR(di->channel_temp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) goto error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) di->channel_bsi = iio_channel_get(di->dev, "bsi");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) if (IS_ERR(di->channel_bsi)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) ret = PTR_ERR(di->channel_bsi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) goto error_channel_temp;
^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) di->channel_vbat = iio_channel_get(di->dev, "vbat");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) if (IS_ERR(di->channel_vbat)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) ret = PTR_ERR(di->channel_vbat);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) goto error_channel_bsi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) di->bat = power_supply_register(di->dev, &di->bat_desc, &psy_cfg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) if (IS_ERR(di->bat)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) ret = PTR_ERR(di->bat);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) goto error_channel_vbat;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) error_channel_vbat:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) iio_channel_release(di->channel_vbat);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) error_channel_bsi:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) iio_channel_release(di->channel_bsi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) error_channel_temp:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) iio_channel_release(di->channel_temp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) error:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) static int rx51_battery_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) struct rx51_device_info *di = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) power_supply_unregister(di->bat);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) iio_channel_release(di->channel_vbat);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) iio_channel_release(di->channel_bsi);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) iio_channel_release(di->channel_temp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) #ifdef CONFIG_OF
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) static const struct of_device_id n900_battery_of_match[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) {.compatible = "nokia,n900-battery", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) { },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) MODULE_DEVICE_TABLE(of, n900_battery_of_match);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) static struct platform_driver rx51_battery_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) .probe = rx51_battery_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) .remove = rx51_battery_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) .name = "rx51-battery",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) .of_match_table = of_match_ptr(n900_battery_of_match),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) module_platform_driver(rx51_battery_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) MODULE_ALIAS("platform:rx51-battery");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) MODULE_AUTHOR("Pali Rohár <pali@kernel.org>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) MODULE_DESCRIPTION("Nokia RX-51 battery driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) MODULE_LICENSE("GPL");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags