^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Power supply driver for the goldfish emulator
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (C) 2008 Google, Inc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Copyright (C) 2012 Intel, Inc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * Copyright (C) 2013 Intel, Inc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * Author: Mike Lockwood <lockwood@android.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/err.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/power_supply.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/pci.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/interrupt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <linux/acpi.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) struct goldfish_battery_data {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) void __iomem *reg_base;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) int irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) spinlock_t lock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) struct power_supply *battery;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) struct power_supply *ac;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #define GOLDFISH_BATTERY_READ(data, addr) \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) (readl(data->reg_base + addr))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) #define GOLDFISH_BATTERY_WRITE(data, addr, x) \
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) (writel(x, data->reg_base + addr))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) enum {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) /* status register */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) BATTERY_INT_STATUS = 0x00,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) /* set this to enable IRQ */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) BATTERY_INT_ENABLE = 0x04,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) BATTERY_AC_ONLINE = 0x08,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) BATTERY_STATUS = 0x0C,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) BATTERY_HEALTH = 0x10,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) BATTERY_PRESENT = 0x14,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) BATTERY_CAPACITY = 0x18,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) BATTERY_VOLTAGE = 0x1C,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) BATTERY_TEMP = 0x20,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) BATTERY_CHARGE_COUNTER = 0x24,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) BATTERY_VOLTAGE_MAX = 0x28,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) BATTERY_CURRENT_MAX = 0x2C,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) BATTERY_CURRENT_NOW = 0x30,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) BATTERY_CURRENT_AVG = 0x34,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) BATTERY_CHARGE_FULL_UAH = 0x38,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) BATTERY_CYCLE_COUNT = 0x40,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) BATTERY_STATUS_CHANGED = 1U << 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) AC_STATUS_CHANGED = 1U << 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) BATTERY_INT_MASK = BATTERY_STATUS_CHANGED | AC_STATUS_CHANGED,
^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) static int goldfish_ac_get_property(struct power_supply *psy,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) enum power_supply_property psp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) union power_supply_propval *val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) struct goldfish_battery_data *data = power_supply_get_drvdata(psy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) switch (psp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) case POWER_SUPPLY_PROP_ONLINE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_AC_ONLINE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) case POWER_SUPPLY_PROP_VOLTAGE_MAX:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_VOLTAGE_MAX);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) case POWER_SUPPLY_PROP_CURRENT_MAX:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_CURRENT_MAX);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) static int goldfish_battery_get_property(struct power_supply *psy,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) enum power_supply_property psp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) union power_supply_propval *val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) struct goldfish_battery_data *data = power_supply_get_drvdata(psy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) switch (psp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) case POWER_SUPPLY_PROP_STATUS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_STATUS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) case POWER_SUPPLY_PROP_HEALTH:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_HEALTH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) case POWER_SUPPLY_PROP_PRESENT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_PRESENT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) case POWER_SUPPLY_PROP_TECHNOLOGY:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) case POWER_SUPPLY_PROP_CAPACITY:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_CAPACITY);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) case POWER_SUPPLY_PROP_VOLTAGE_NOW:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_VOLTAGE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) case POWER_SUPPLY_PROP_TEMP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_TEMP);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) case POWER_SUPPLY_PROP_CHARGE_COUNTER:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) val->intval = GOLDFISH_BATTERY_READ(data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) BATTERY_CHARGE_COUNTER);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) case POWER_SUPPLY_PROP_CURRENT_NOW:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_CURRENT_NOW);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) case POWER_SUPPLY_PROP_CURRENT_AVG:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_CURRENT_AVG);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) case POWER_SUPPLY_PROP_CHARGE_FULL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) val->intval = GOLDFISH_BATTERY_READ(data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) BATTERY_CHARGE_FULL_UAH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) case POWER_SUPPLY_PROP_CYCLE_COUNT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_CYCLE_COUNT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) static enum power_supply_property goldfish_battery_props[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) POWER_SUPPLY_PROP_STATUS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) POWER_SUPPLY_PROP_HEALTH,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) POWER_SUPPLY_PROP_PRESENT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) POWER_SUPPLY_PROP_TECHNOLOGY,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) POWER_SUPPLY_PROP_CAPACITY,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) POWER_SUPPLY_PROP_VOLTAGE_NOW,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) POWER_SUPPLY_PROP_TEMP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) POWER_SUPPLY_PROP_CHARGE_COUNTER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) POWER_SUPPLY_PROP_CURRENT_NOW,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) POWER_SUPPLY_PROP_CURRENT_AVG,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) POWER_SUPPLY_PROP_CHARGE_FULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) POWER_SUPPLY_PROP_CYCLE_COUNT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) static enum power_supply_property goldfish_ac_props[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) POWER_SUPPLY_PROP_ONLINE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) POWER_SUPPLY_PROP_VOLTAGE_MAX,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) POWER_SUPPLY_PROP_CURRENT_MAX,
^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) static irqreturn_t goldfish_battery_interrupt(int irq, void *dev_id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) unsigned long irq_flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) struct goldfish_battery_data *data = dev_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) uint32_t status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) spin_lock_irqsave(&data->lock, irq_flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) /* read status flags, which will clear the interrupt */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) status = GOLDFISH_BATTERY_READ(data, BATTERY_INT_STATUS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) status &= BATTERY_INT_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) if (status & BATTERY_STATUS_CHANGED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) power_supply_changed(data->battery);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) if (status & AC_STATUS_CHANGED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) power_supply_changed(data->ac);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) spin_unlock_irqrestore(&data->lock, irq_flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) return status ? IRQ_HANDLED : IRQ_NONE;
^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 const struct power_supply_desc battery_desc = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) .properties = goldfish_battery_props,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) .num_properties = ARRAY_SIZE(goldfish_battery_props),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) .get_property = goldfish_battery_get_property,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) .name = "battery",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) .type = POWER_SUPPLY_TYPE_BATTERY,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) static const struct power_supply_desc ac_desc = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) .properties = goldfish_ac_props,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) .num_properties = ARRAY_SIZE(goldfish_ac_props),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) .get_property = goldfish_ac_get_property,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) .name = "ac",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) .type = POWER_SUPPLY_TYPE_MAINS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) static int goldfish_battery_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) struct resource *r;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) struct goldfish_battery_data *data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) struct power_supply_config psy_cfg = {};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) if (data == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) spin_lock_init(&data->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) if (r == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) dev_err(&pdev->dev, "platform_get_resource failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) data->reg_base = devm_ioremap(&pdev->dev, r->start, resource_size(r));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) if (data->reg_base == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) dev_err(&pdev->dev, "unable to remap MMIO\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) data->irq = platform_get_irq(pdev, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) if (data->irq < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) dev_err(&pdev->dev, "platform_get_irq failed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) ret = devm_request_irq(&pdev->dev, data->irq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) goldfish_battery_interrupt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) IRQF_SHARED, pdev->name, data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) psy_cfg.drv_data = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) data->ac = power_supply_register(&pdev->dev, &ac_desc, &psy_cfg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) if (IS_ERR(data->ac))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) return PTR_ERR(data->ac);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) data->battery = power_supply_register(&pdev->dev, &battery_desc,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) &psy_cfg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) if (IS_ERR(data->battery)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) power_supply_unregister(data->ac);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) return PTR_ERR(data->battery);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) platform_set_drvdata(pdev, data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) GOLDFISH_BATTERY_WRITE(data, BATTERY_INT_ENABLE, BATTERY_INT_MASK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) static int goldfish_battery_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) struct goldfish_battery_data *data = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) power_supply_unregister(data->battery);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) power_supply_unregister(data->ac);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) static const struct of_device_id goldfish_battery_of_match[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) { .compatible = "google,goldfish-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, goldfish_battery_of_match);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) #ifdef CONFIG_ACPI
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) static const struct acpi_device_id goldfish_battery_acpi_match[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) { "GFSH0001", 0 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) { },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) MODULE_DEVICE_TABLE(acpi, goldfish_battery_acpi_match);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) static struct platform_driver goldfish_battery_device = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) .probe = goldfish_battery_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) .remove = goldfish_battery_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) .name = "goldfish-battery",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) .of_match_table = goldfish_battery_of_match,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) .acpi_match_table = ACPI_PTR(goldfish_battery_acpi_match),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) module_platform_driver(goldfish_battery_device);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) MODULE_AUTHOR("Mike Lockwood lockwood@android.com");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) MODULE_DESCRIPTION("Battery driver for the Goldfish emulator");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags