1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378 |
- /*
- * Copyright (C) ST-Ericsson SA 2010
- *
- * License Terms: GNU General Public License v2
- * Author: Srinidhi Kasagar <srinidhi.kasagar@stericsson.com>
- * Author: Rabin Vincent <rabin.vincent@stericsson.com>
- * Author: Mattias Wallin <mattias.wallin@stericsson.com>
- */
- #include <linux/kernel.h>
- #include <linux/slab.h>
- #include <linux/init.h>
- #include <linux/irq.h>
- #include <linux/irqdomain.h>
- #include <linux/delay.h>
- #include <linux/interrupt.h>
- #include <linux/module.h>
- #include <linux/platform_device.h>
- #include <linux/mfd/core.h>
- #include <linux/mfd/abx500.h>
- #include <linux/mfd/abx500/ab8500.h>
- #include <linux/mfd/abx500/ab8500-bm.h>
- #include <linux/mfd/dbx500-prcmu.h>
- #include <linux/regulator/ab8500.h>
- #include <linux/of.h>
- #include <linux/of_device.h>
- /*
- * Interrupt register offsets
- * Bank : 0x0E
- */
- #define AB8500_IT_SOURCE1_REG 0x00
- #define AB8500_IT_SOURCE2_REG 0x01
- #define AB8500_IT_SOURCE3_REG 0x02
- #define AB8500_IT_SOURCE4_REG 0x03
- #define AB8500_IT_SOURCE5_REG 0x04
- #define AB8500_IT_SOURCE6_REG 0x05
- #define AB8500_IT_SOURCE7_REG 0x06
- #define AB8500_IT_SOURCE8_REG 0x07
- #define AB9540_IT_SOURCE13_REG 0x0C
- #define AB8500_IT_SOURCE19_REG 0x12
- #define AB8500_IT_SOURCE20_REG 0x13
- #define AB8500_IT_SOURCE21_REG 0x14
- #define AB8500_IT_SOURCE22_REG 0x15
- #define AB8500_IT_SOURCE23_REG 0x16
- #define AB8500_IT_SOURCE24_REG 0x17
- /*
- * latch registers
- */
- #define AB8500_IT_LATCH1_REG 0x20
- #define AB8500_IT_LATCH2_REG 0x21
- #define AB8500_IT_LATCH3_REG 0x22
- #define AB8500_IT_LATCH4_REG 0x23
- #define AB8500_IT_LATCH5_REG 0x24
- #define AB8500_IT_LATCH6_REG 0x25
- #define AB8500_IT_LATCH7_REG 0x26
- #define AB8500_IT_LATCH8_REG 0x27
- #define AB8500_IT_LATCH9_REG 0x28
- #define AB8500_IT_LATCH10_REG 0x29
- #define AB8500_IT_LATCH12_REG 0x2B
- #define AB9540_IT_LATCH13_REG 0x2C
- #define AB8500_IT_LATCH19_REG 0x32
- #define AB8500_IT_LATCH20_REG 0x33
- #define AB8500_IT_LATCH21_REG 0x34
- #define AB8500_IT_LATCH22_REG 0x35
- #define AB8500_IT_LATCH23_REG 0x36
- #define AB8500_IT_LATCH24_REG 0x37
- /*
- * mask registers
- */
- #define AB8500_IT_MASK1_REG 0x40
- #define AB8500_IT_MASK2_REG 0x41
- #define AB8500_IT_MASK3_REG 0x42
- #define AB8500_IT_MASK4_REG 0x43
- #define AB8500_IT_MASK5_REG 0x44
- #define AB8500_IT_MASK6_REG 0x45
- #define AB8500_IT_MASK7_REG 0x46
- #define AB8500_IT_MASK8_REG 0x47
- #define AB8500_IT_MASK9_REG 0x48
- #define AB8500_IT_MASK10_REG 0x49
- #define AB8500_IT_MASK11_REG 0x4A
- #define AB8500_IT_MASK12_REG 0x4B
- #define AB8500_IT_MASK13_REG 0x4C
- #define AB8500_IT_MASK14_REG 0x4D
- #define AB8500_IT_MASK15_REG 0x4E
- #define AB8500_IT_MASK16_REG 0x4F
- #define AB8500_IT_MASK17_REG 0x50
- #define AB8500_IT_MASK18_REG 0x51
- #define AB8500_IT_MASK19_REG 0x52
- #define AB8500_IT_MASK20_REG 0x53
- #define AB8500_IT_MASK21_REG 0x54
- #define AB8500_IT_MASK22_REG 0x55
- #define AB8500_IT_MASK23_REG 0x56
- #define AB8500_IT_MASK24_REG 0x57
- #define AB8500_IT_MASK25_REG 0x58
- /*
- * latch hierarchy registers
- */
- #define AB8500_IT_LATCHHIER1_REG 0x60
- #define AB8500_IT_LATCHHIER2_REG 0x61
- #define AB8500_IT_LATCHHIER3_REG 0x62
- #define AB8540_IT_LATCHHIER4_REG 0x63
- #define AB8500_IT_LATCHHIER_NUM 3
- #define AB8540_IT_LATCHHIER_NUM 4
- #define AB8500_REV_REG 0x80
- #define AB8500_IC_NAME_REG 0x82
- #define AB8500_SWITCH_OFF_STATUS 0x00
- #define AB8500_TURN_ON_STATUS 0x00
- #define AB8505_TURN_ON_STATUS_2 0x04
- #define AB8500_CH_USBCH_STAT1_REG 0x02
- #define VBUS_DET_DBNC100 0x02
- #define VBUS_DET_DBNC1 0x01
- static DEFINE_SPINLOCK(on_stat_lock);
- static u8 turn_on_stat_mask = 0xFF;
- static u8 turn_on_stat_set;
- static bool no_bm; /* No battery management */
- module_param(no_bm, bool, S_IRUGO);
- #define AB9540_MODEM_CTRL2_REG 0x23
- #define AB9540_MODEM_CTRL2_SWDBBRSTN_BIT BIT(2)
- /*
- * Map interrupt numbers to the LATCH and MASK register offsets, Interrupt
- * numbers are indexed into this array with (num / 8). The interupts are
- * defined in linux/mfd/ab8500.h
- *
- * This is one off from the register names, i.e. AB8500_IT_MASK1_REG is at
- * offset 0.
- */
- /* AB8500 support */
- static const int ab8500_irq_regoffset[AB8500_NUM_IRQ_REGS] = {
- 0, 1, 2, 3, 4, 6, 7, 8, 9, 11, 18, 19, 20, 21,
- };
- /* AB9540 / AB8505 support */
- static const int ab9540_irq_regoffset[AB9540_NUM_IRQ_REGS] = {
- 0, 1, 2, 3, 4, 6, 7, 8, 9, 11, 18, 19, 20, 21, 12, 13, 24, 5, 22, 23
- };
- /* AB8540 support */
- static const int ab8540_irq_regoffset[AB8540_NUM_IRQ_REGS] = {
- 0, 1, 2, 3, 4, -1, -1, -1, -1, 11, 18, 19, 20, 21, 12, 13, 24, 5, 22,
- 23, 25, 26, 27, 28, 29, 30, 31,
- };
- static const char ab8500_version_str[][7] = {
- [AB8500_VERSION_AB8500] = "AB8500",
- [AB8500_VERSION_AB8505] = "AB8505",
- [AB8500_VERSION_AB9540] = "AB9540",
- [AB8500_VERSION_AB8540] = "AB8540",
- };
- static int ab8500_prcmu_write(struct ab8500 *ab8500, u16 addr, u8 data)
- {
- int ret;
- ret = prcmu_abb_write((u8)(addr >> 8), (u8)(addr & 0xFF), &data, 1);
- if (ret < 0)
- dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
- return ret;
- }
- static int ab8500_prcmu_write_masked(struct ab8500 *ab8500, u16 addr, u8 mask,
- u8 data)
- {
- int ret;
- ret = prcmu_abb_write_masked((u8)(addr >> 8), (u8)(addr & 0xFF), &data,
- &mask, 1);
- if (ret < 0)
- dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
- return ret;
- }
- static int ab8500_prcmu_read(struct ab8500 *ab8500, u16 addr)
- {
- int ret;
- u8 data;
- ret = prcmu_abb_read((u8)(addr >> 8), (u8)(addr & 0xFF), &data, 1);
- if (ret < 0) {
- dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
- return ret;
- }
- return (int)data;
- }
- static int ab8500_get_chip_id(struct device *dev)
- {
- struct ab8500 *ab8500;
- if (!dev)
- return -EINVAL;
- ab8500 = dev_get_drvdata(dev->parent);
- return ab8500 ? (int)ab8500->chip_id : -EINVAL;
- }
- static int set_register_interruptible(struct ab8500 *ab8500, u8 bank,
- u8 reg, u8 data)
- {
- int ret;
- /*
- * Put the u8 bank and u8 register together into a an u16.
- * The bank on higher 8 bits and register in lower 8 bits.
- */
- u16 addr = ((u16)bank) << 8 | reg;
- dev_vdbg(ab8500->dev, "wr: addr %#x <= %#x\n", addr, data);
- mutex_lock(&ab8500->lock);
- ret = ab8500->write(ab8500, addr, data);
- if (ret < 0)
- dev_err(ab8500->dev, "failed to write reg %#x: %d\n",
- addr, ret);
- mutex_unlock(&ab8500->lock);
- return ret;
- }
- static int ab8500_set_register(struct device *dev, u8 bank,
- u8 reg, u8 value)
- {
- int ret;
- struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
- atomic_inc(&ab8500->transfer_ongoing);
- ret = set_register_interruptible(ab8500, bank, reg, value);
- atomic_dec(&ab8500->transfer_ongoing);
- return ret;
- }
- static int get_register_interruptible(struct ab8500 *ab8500, u8 bank,
- u8 reg, u8 *value)
- {
- int ret;
- u16 addr = ((u16)bank) << 8 | reg;
- mutex_lock(&ab8500->lock);
- ret = ab8500->read(ab8500, addr);
- if (ret < 0)
- dev_err(ab8500->dev, "failed to read reg %#x: %d\n",
- addr, ret);
- else
- *value = ret;
- mutex_unlock(&ab8500->lock);
- dev_vdbg(ab8500->dev, "rd: addr %#x => data %#x\n", addr, ret);
- return ret;
- }
- static int ab8500_get_register(struct device *dev, u8 bank,
- u8 reg, u8 *value)
- {
- int ret;
- struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
- atomic_inc(&ab8500->transfer_ongoing);
- ret = get_register_interruptible(ab8500, bank, reg, value);
- atomic_dec(&ab8500->transfer_ongoing);
- return ret;
- }
- static int mask_and_set_register_interruptible(struct ab8500 *ab8500, u8 bank,
- u8 reg, u8 bitmask, u8 bitvalues)
- {
- int ret;
- u16 addr = ((u16)bank) << 8 | reg;
- mutex_lock(&ab8500->lock);
- if (ab8500->write_masked == NULL) {
- u8 data;
- ret = ab8500->read(ab8500, addr);
- if (ret < 0) {
- dev_err(ab8500->dev, "failed to read reg %#x: %d\n",
- addr, ret);
- goto out;
- }
- data = (u8)ret;
- data = (~bitmask & data) | (bitmask & bitvalues);
- ret = ab8500->write(ab8500, addr, data);
- if (ret < 0)
- dev_err(ab8500->dev, "failed to write reg %#x: %d\n",
- addr, ret);
- dev_vdbg(ab8500->dev, "mask: addr %#x => data %#x\n", addr,
- data);
- goto out;
- }
- ret = ab8500->write_masked(ab8500, addr, bitmask, bitvalues);
- if (ret < 0)
- dev_err(ab8500->dev, "failed to modify reg %#x: %d\n", addr,
- ret);
- out:
- mutex_unlock(&ab8500->lock);
- return ret;
- }
- static int ab8500_mask_and_set_register(struct device *dev,
- u8 bank, u8 reg, u8 bitmask, u8 bitvalues)
- {
- int ret;
- struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
- atomic_inc(&ab8500->transfer_ongoing);
- ret = mask_and_set_register_interruptible(ab8500, bank, reg,
- bitmask, bitvalues);
- atomic_dec(&ab8500->transfer_ongoing);
- return ret;
- }
- static struct abx500_ops ab8500_ops = {
- .get_chip_id = ab8500_get_chip_id,
- .get_register = ab8500_get_register,
- .set_register = ab8500_set_register,
- .get_register_page = NULL,
- .set_register_page = NULL,
- .mask_and_set_register = ab8500_mask_and_set_register,
- .event_registers_startup_state_get = NULL,
- .startup_irq_enabled = NULL,
- .dump_all_banks = ab8500_dump_all_banks,
- };
- static void ab8500_irq_lock(struct irq_data *data)
- {
- struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
- mutex_lock(&ab8500->irq_lock);
- atomic_inc(&ab8500->transfer_ongoing);
- }
- static void ab8500_irq_sync_unlock(struct irq_data *data)
- {
- struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
- int i;
- for (i = 0; i < ab8500->mask_size; i++) {
- u8 old = ab8500->oldmask[i];
- u8 new = ab8500->mask[i];
- int reg;
- if (new == old)
- continue;
- /*
- * Interrupt register 12 doesn't exist prior to AB8500 version
- * 2.0
- */
- if (ab8500->irq_reg_offset[i] == 11 &&
- is_ab8500_1p1_or_earlier(ab8500))
- continue;
- if (ab8500->irq_reg_offset[i] < 0)
- continue;
- ab8500->oldmask[i] = new;
- reg = AB8500_IT_MASK1_REG + ab8500->irq_reg_offset[i];
- set_register_interruptible(ab8500, AB8500_INTERRUPT, reg, new);
- }
- atomic_dec(&ab8500->transfer_ongoing);
- mutex_unlock(&ab8500->irq_lock);
- }
- static void ab8500_irq_mask(struct irq_data *data)
- {
- struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
- int offset = data->hwirq;
- int index = offset / 8;
- int mask = 1 << (offset % 8);
- ab8500->mask[index] |= mask;
- /* The AB8500 GPIOs have two interrupts each (rising & falling). */
- if (offset >= AB8500_INT_GPIO6R && offset <= AB8500_INT_GPIO41R)
- ab8500->mask[index + 2] |= mask;
- if (offset >= AB9540_INT_GPIO50R && offset <= AB9540_INT_GPIO54R)
- ab8500->mask[index + 1] |= mask;
- if (offset == AB8540_INT_GPIO43R || offset == AB8540_INT_GPIO44R)
- /* Here the falling IRQ is one bit lower */
- ab8500->mask[index] |= (mask << 1);
- }
- static void ab8500_irq_unmask(struct irq_data *data)
- {
- struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
- unsigned int type = irqd_get_trigger_type(data);
- int offset = data->hwirq;
- int index = offset / 8;
- int mask = 1 << (offset % 8);
- if (type & IRQ_TYPE_EDGE_RISING)
- ab8500->mask[index] &= ~mask;
- /* The AB8500 GPIOs have two interrupts each (rising & falling). */
- if (type & IRQ_TYPE_EDGE_FALLING) {
- if (offset >= AB8500_INT_GPIO6R && offset <= AB8500_INT_GPIO41R)
- ab8500->mask[index + 2] &= ~mask;
- else if (offset >= AB9540_INT_GPIO50R &&
- offset <= AB9540_INT_GPIO54R)
- ab8500->mask[index + 1] &= ~mask;
- else if (offset == AB8540_INT_GPIO43R ||
- offset == AB8540_INT_GPIO44R)
- /* Here the falling IRQ is one bit lower */
- ab8500->mask[index] &= ~(mask << 1);
- else
- ab8500->mask[index] &= ~mask;
- } else {
- /* Satisfies the case where type is not set. */
- ab8500->mask[index] &= ~mask;
- }
- }
- static int ab8500_irq_set_type(struct irq_data *data, unsigned int type)
- {
- return 0;
- }
- static struct irq_chip ab8500_irq_chip = {
- .name = "ab8500",
- .irq_bus_lock = ab8500_irq_lock,
- .irq_bus_sync_unlock = ab8500_irq_sync_unlock,
- .irq_mask = ab8500_irq_mask,
- .irq_disable = ab8500_irq_mask,
- .irq_unmask = ab8500_irq_unmask,
- .irq_set_type = ab8500_irq_set_type,
- };
- static void update_latch_offset(u8 *offset, int i)
- {
- /* Fix inconsistent ITFromLatch25 bit mapping... */
- if (unlikely(*offset == 17))
- *offset = 24;
- /* Fix inconsistent ab8540 bit mapping... */
- if (unlikely(*offset == 16))
- *offset = 25;
- if ((i == 3) && (*offset >= 24))
- *offset += 2;
- }
- static int ab8500_handle_hierarchical_line(struct ab8500 *ab8500,
- int latch_offset, u8 latch_val)
- {
- int int_bit, line, i;
- for (i = 0; i < ab8500->mask_size; i++)
- if (ab8500->irq_reg_offset[i] == latch_offset)
- break;
- if (i >= ab8500->mask_size) {
- dev_err(ab8500->dev, "Register offset 0x%2x not declared\n",
- latch_offset);
- return -ENXIO;
- }
- /* ignore masked out interrupts */
- latch_val &= ~ab8500->mask[i];
- while (latch_val) {
- int_bit = __ffs(latch_val);
- line = (i << 3) + int_bit;
- latch_val &= ~(1 << int_bit);
- /*
- * This handles the falling edge hwirqs from the GPIO
- * lines. Route them back to the line registered for the
- * rising IRQ, as this is merely a flag for the same IRQ
- * in linux terms.
- */
- if (line >= AB8500_INT_GPIO6F && line <= AB8500_INT_GPIO41F)
- line -= 16;
- if (line >= AB9540_INT_GPIO50F && line <= AB9540_INT_GPIO54F)
- line -= 8;
- if (line == AB8540_INT_GPIO43F || line == AB8540_INT_GPIO44F)
- line += 1;
- handle_nested_irq(irq_create_mapping(ab8500->domain, line));
- }
- return 0;
- }
- static int ab8500_handle_hierarchical_latch(struct ab8500 *ab8500,
- int hier_offset, u8 hier_val)
- {
- int latch_bit, status;
- u8 latch_offset, latch_val;
- do {
- latch_bit = __ffs(hier_val);
- latch_offset = (hier_offset << 3) + latch_bit;
- update_latch_offset(&latch_offset, hier_offset);
- status = get_register_interruptible(ab8500,
- AB8500_INTERRUPT,
- AB8500_IT_LATCH1_REG + latch_offset,
- &latch_val);
- if (status < 0 || latch_val == 0)
- goto discard;
- status = ab8500_handle_hierarchical_line(ab8500,
- latch_offset, latch_val);
- if (status < 0)
- return status;
- discard:
- hier_val &= ~(1 << latch_bit);
- } while (hier_val);
- return 0;
- }
- static irqreturn_t ab8500_hierarchical_irq(int irq, void *dev)
- {
- struct ab8500 *ab8500 = dev;
- u8 i;
- dev_vdbg(ab8500->dev, "interrupt\n");
- /* Hierarchical interrupt version */
- for (i = 0; i < (ab8500->it_latchhier_num); i++) {
- int status;
- u8 hier_val;
- status = get_register_interruptible(ab8500, AB8500_INTERRUPT,
- AB8500_IT_LATCHHIER1_REG + i, &hier_val);
- if (status < 0 || hier_val == 0)
- continue;
- status = ab8500_handle_hierarchical_latch(ab8500, i, hier_val);
- if (status < 0)
- break;
- }
- return IRQ_HANDLED;
- }
- static int ab8500_irq_map(struct irq_domain *d, unsigned int virq,
- irq_hw_number_t hwirq)
- {
- struct ab8500 *ab8500 = d->host_data;
- if (!ab8500)
- return -EINVAL;
- irq_set_chip_data(virq, ab8500);
- irq_set_chip_and_handler(virq, &ab8500_irq_chip,
- handle_simple_irq);
- irq_set_nested_thread(virq, 1);
- irq_set_noprobe(virq);
- return 0;
- }
- static const struct irq_domain_ops ab8500_irq_ops = {
- .map = ab8500_irq_map,
- .xlate = irq_domain_xlate_twocell,
- };
- static int ab8500_irq_init(struct ab8500 *ab8500, struct device_node *np)
- {
- int num_irqs;
- if (is_ab8540(ab8500))
- num_irqs = AB8540_NR_IRQS;
- else if (is_ab9540(ab8500))
- num_irqs = AB9540_NR_IRQS;
- else if (is_ab8505(ab8500))
- num_irqs = AB8505_NR_IRQS;
- else
- num_irqs = AB8500_NR_IRQS;
- /* If ->irq_base is zero this will give a linear mapping */
- ab8500->domain = irq_domain_add_simple(ab8500->dev->of_node,
- num_irqs, 0,
- &ab8500_irq_ops, ab8500);
- if (!ab8500->domain) {
- dev_err(ab8500->dev, "Failed to create irqdomain\n");
- return -ENODEV;
- }
- return 0;
- }
- int ab8500_suspend(struct ab8500 *ab8500)
- {
- if (atomic_read(&ab8500->transfer_ongoing))
- return -EINVAL;
- return 0;
- }
- static const struct mfd_cell ab8500_bm_devs[] = {
- {
- .name = "ab8500-charger",
- .of_compatible = "stericsson,ab8500-charger",
- .platform_data = &ab8500_bm_data,
- .pdata_size = sizeof(ab8500_bm_data),
- },
- {
- .name = "ab8500-btemp",
- .of_compatible = "stericsson,ab8500-btemp",
- .platform_data = &ab8500_bm_data,
- .pdata_size = sizeof(ab8500_bm_data),
- },
- {
- .name = "ab8500-fg",
- .of_compatible = "stericsson,ab8500-fg",
- .platform_data = &ab8500_bm_data,
- .pdata_size = sizeof(ab8500_bm_data),
- },
- {
- .name = "ab8500-chargalg",
- .of_compatible = "stericsson,ab8500-chargalg",
- .platform_data = &ab8500_bm_data,
- .pdata_size = sizeof(ab8500_bm_data),
- },
- };
- static const struct mfd_cell ab8500_devs[] = {
- #ifdef CONFIG_DEBUG_FS
- {
- .name = "ab8500-debug",
- .of_compatible = "stericsson,ab8500-debug",
- },
- #endif
- {
- .name = "ab8500-sysctrl",
- .of_compatible = "stericsson,ab8500-sysctrl",
- },
- {
- .name = "ab8500-ext-regulator",
- .of_compatible = "stericsson,ab8500-ext-regulator",
- },
- {
- .name = "ab8500-regulator",
- .of_compatible = "stericsson,ab8500-regulator",
- },
- {
- .name = "abx500-clk",
- .of_compatible = "stericsson,abx500-clk",
- },
- {
- .name = "ab8500-gpadc",
- .of_compatible = "stericsson,ab8500-gpadc",
- },
- {
- .name = "ab8500-rtc",
- .of_compatible = "stericsson,ab8500-rtc",
- },
- {
- .name = "ab8500-acc-det",
- .of_compatible = "stericsson,ab8500-acc-det",
- },
- {
- .name = "ab8500-poweron-key",
- .of_compatible = "stericsson,ab8500-poweron-key",
- },
- {
- .name = "ab8500-pwm",
- .of_compatible = "stericsson,ab8500-pwm",
- .id = 1,
- },
- {
- .name = "ab8500-pwm",
- .of_compatible = "stericsson,ab8500-pwm",
- .id = 2,
- },
- {
- .name = "ab8500-pwm",
- .of_compatible = "stericsson,ab8500-pwm",
- .id = 3,
- },
- {
- .name = "ab8500-denc",
- .of_compatible = "stericsson,ab8500-denc",
- },
- {
- .name = "pinctrl-ab8500",
- .of_compatible = "stericsson,ab8500-gpio",
- },
- {
- .name = "abx500-temp",
- .of_compatible = "stericsson,abx500-temp",
- },
- {
- .name = "ab8500-usb",
- .of_compatible = "stericsson,ab8500-usb",
- },
- {
- .name = "ab8500-codec",
- .of_compatible = "stericsson,ab8500-codec",
- },
- };
- static const struct mfd_cell ab9540_devs[] = {
- #ifdef CONFIG_DEBUG_FS
- {
- .name = "ab8500-debug",
- },
- #endif
- {
- .name = "ab8500-sysctrl",
- },
- {
- .name = "ab8500-ext-regulator",
- },
- {
- .name = "ab8500-regulator",
- },
- {
- .name = "abx500-clk",
- .of_compatible = "stericsson,abx500-clk",
- },
- {
- .name = "ab8500-gpadc",
- .of_compatible = "stericsson,ab8500-gpadc",
- },
- {
- .name = "ab8500-rtc",
- },
- {
- .name = "ab8500-acc-det",
- },
- {
- .name = "ab8500-poweron-key",
- },
- {
- .name = "ab8500-pwm",
- .id = 1,
- },
- {
- .name = "abx500-temp",
- },
- {
- .name = "pinctrl-ab9540",
- .of_compatible = "stericsson,ab9540-gpio",
- },
- {
- .name = "ab9540-usb",
- },
- {
- .name = "ab9540-codec",
- },
- {
- .name = "ab-iddet",
- },
- };
- /* Device list for ab8505 */
- static const struct mfd_cell ab8505_devs[] = {
- #ifdef CONFIG_DEBUG_FS
- {
- .name = "ab8500-debug",
- },
- #endif
- {
- .name = "ab8500-sysctrl",
- },
- {
- .name = "ab8500-regulator",
- },
- {
- .name = "abx500-clk",
- .of_compatible = "stericsson,abx500-clk",
- },
- {
- .name = "ab8500-gpadc",
- .of_compatible = "stericsson,ab8500-gpadc",
- },
- {
- .name = "ab8500-rtc",
- },
- {
- .name = "ab8500-acc-det",
- },
- {
- .name = "ab8500-poweron-key",
- },
- {
- .name = "ab8500-pwm",
- .id = 1,
- },
- {
- .name = "pinctrl-ab8505",
- },
- {
- .name = "ab8500-usb",
- },
- {
- .name = "ab8500-codec",
- },
- {
- .name = "ab-iddet",
- },
- };
- static const struct mfd_cell ab8540_devs[] = {
- #ifdef CONFIG_DEBUG_FS
- {
- .name = "ab8500-debug",
- },
- #endif
- {
- .name = "ab8500-sysctrl",
- },
- {
- .name = "ab8500-ext-regulator",
- },
- {
- .name = "ab8500-regulator",
- },
- {
- .name = "abx500-clk",
- .of_compatible = "stericsson,abx500-clk",
- },
- {
- .name = "ab8500-gpadc",
- .of_compatible = "stericsson,ab8500-gpadc",
- },
- {
- .name = "ab8500-acc-det",
- },
- {
- .name = "ab8500-poweron-key",
- },
- {
- .name = "ab8500-pwm",
- .id = 1,
- },
- {
- .name = "abx500-temp",
- },
- {
- .name = "pinctrl-ab8540",
- },
- {
- .name = "ab8540-usb",
- },
- {
- .name = "ab8540-codec",
- },
- {
- .name = "ab-iddet",
- },
- };
- static const struct mfd_cell ab8540_cut1_devs[] = {
- {
- .name = "ab8500-rtc",
- .of_compatible = "stericsson,ab8500-rtc",
- },
- };
- static const struct mfd_cell ab8540_cut2_devs[] = {
- {
- .name = "ab8540-rtc",
- .of_compatible = "stericsson,ab8540-rtc",
- },
- };
- static ssize_t show_chip_id(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct ab8500 *ab8500;
- ab8500 = dev_get_drvdata(dev);
- return sprintf(buf, "%#x\n", ab8500 ? ab8500->chip_id : -EINVAL);
- }
- /*
- * ab8500 has switched off due to (SWITCH_OFF_STATUS):
- * 0x01 Swoff bit programming
- * 0x02 Thermal protection activation
- * 0x04 Vbat lower then BattOk falling threshold
- * 0x08 Watchdog expired
- * 0x10 Non presence of 32kHz clock
- * 0x20 Battery level lower than power on reset threshold
- * 0x40 Power on key 1 pressed longer than 10 seconds
- * 0x80 DB8500 thermal shutdown
- */
- static ssize_t show_switch_off_status(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- int ret;
- u8 value;
- struct ab8500 *ab8500;
- ab8500 = dev_get_drvdata(dev);
- ret = get_register_interruptible(ab8500, AB8500_RTC,
- AB8500_SWITCH_OFF_STATUS, &value);
- if (ret < 0)
- return ret;
- return sprintf(buf, "%#x\n", value);
- }
- /* use mask and set to override the register turn_on_stat value */
- void ab8500_override_turn_on_stat(u8 mask, u8 set)
- {
- spin_lock(&on_stat_lock);
- turn_on_stat_mask = mask;
- turn_on_stat_set = set;
- spin_unlock(&on_stat_lock);
- }
- /*
- * ab8500 has turned on due to (TURN_ON_STATUS):
- * 0x01 PORnVbat
- * 0x02 PonKey1dbF
- * 0x04 PonKey2dbF
- * 0x08 RTCAlarm
- * 0x10 MainChDet
- * 0x20 VbusDet
- * 0x40 UsbIDDetect
- * 0x80 Reserved
- */
- static ssize_t show_turn_on_status(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- int ret;
- u8 value;
- struct ab8500 *ab8500;
- ab8500 = dev_get_drvdata(dev);
- ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
- AB8500_TURN_ON_STATUS, &value);
- if (ret < 0)
- return ret;
- /*
- * In L9540, turn_on_status register is not updated correctly if
- * the device is rebooted with AC/USB charger connected. Due to
- * this, the device boots android instead of entering into charge
- * only mode. Read the AC/USB status register to detect the charger
- * presence and update the turn on status manually.
- */
- if (is_ab9540(ab8500)) {
- spin_lock(&on_stat_lock);
- value = (value & turn_on_stat_mask) | turn_on_stat_set;
- spin_unlock(&on_stat_lock);
- }
- return sprintf(buf, "%#x\n", value);
- }
- static ssize_t show_turn_on_status_2(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- int ret;
- u8 value;
- struct ab8500 *ab8500;
- ab8500 = dev_get_drvdata(dev);
- ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
- AB8505_TURN_ON_STATUS_2, &value);
- if (ret < 0)
- return ret;
- return sprintf(buf, "%#x\n", (value & 0x1));
- }
- static ssize_t show_ab9540_dbbrstn(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct ab8500 *ab8500;
- int ret;
- u8 value;
- ab8500 = dev_get_drvdata(dev);
- ret = get_register_interruptible(ab8500, AB8500_REGU_CTRL2,
- AB9540_MODEM_CTRL2_REG, &value);
- if (ret < 0)
- return ret;
- return sprintf(buf, "%d\n",
- (value & AB9540_MODEM_CTRL2_SWDBBRSTN_BIT) ? 1 : 0);
- }
- static ssize_t store_ab9540_dbbrstn(struct device *dev,
- struct device_attribute *attr, const char *buf, size_t count)
- {
- struct ab8500 *ab8500;
- int ret = count;
- int err;
- u8 bitvalues;
- ab8500 = dev_get_drvdata(dev);
- if (count > 0) {
- switch (buf[0]) {
- case '0':
- bitvalues = 0;
- break;
- case '1':
- bitvalues = AB9540_MODEM_CTRL2_SWDBBRSTN_BIT;
- break;
- default:
- goto exit;
- }
- err = mask_and_set_register_interruptible(ab8500,
- AB8500_REGU_CTRL2, AB9540_MODEM_CTRL2_REG,
- AB9540_MODEM_CTRL2_SWDBBRSTN_BIT, bitvalues);
- if (err)
- dev_info(ab8500->dev,
- "Failed to set DBBRSTN %c, err %#x\n",
- buf[0], err);
- }
- exit:
- return ret;
- }
- static DEVICE_ATTR(chip_id, S_IRUGO, show_chip_id, NULL);
- static DEVICE_ATTR(switch_off_status, S_IRUGO, show_switch_off_status, NULL);
- static DEVICE_ATTR(turn_on_status, S_IRUGO, show_turn_on_status, NULL);
- static DEVICE_ATTR(turn_on_status_2, S_IRUGO, show_turn_on_status_2, NULL);
- static DEVICE_ATTR(dbbrstn, S_IRUGO | S_IWUSR,
- show_ab9540_dbbrstn, store_ab9540_dbbrstn);
- static struct attribute *ab8500_sysfs_entries[] = {
- &dev_attr_chip_id.attr,
- &dev_attr_switch_off_status.attr,
- &dev_attr_turn_on_status.attr,
- NULL,
- };
- static struct attribute *ab8505_sysfs_entries[] = {
- &dev_attr_turn_on_status_2.attr,
- NULL,
- };
- static struct attribute *ab9540_sysfs_entries[] = {
- &dev_attr_chip_id.attr,
- &dev_attr_switch_off_status.attr,
- &dev_attr_turn_on_status.attr,
- &dev_attr_dbbrstn.attr,
- NULL,
- };
- static struct attribute_group ab8500_attr_group = {
- .attrs = ab8500_sysfs_entries,
- };
- static struct attribute_group ab8505_attr_group = {
- .attrs = ab8505_sysfs_entries,
- };
- static struct attribute_group ab9540_attr_group = {
- .attrs = ab9540_sysfs_entries,
- };
- static int ab8500_probe(struct platform_device *pdev)
- {
- static const char * const switch_off_status[] = {
- "Swoff bit programming",
- "Thermal protection activation",
- "Vbat lower then BattOk falling threshold",
- "Watchdog expired",
- "Non presence of 32kHz clock",
- "Battery level lower than power on reset threshold",
- "Power on key 1 pressed longer than 10 seconds",
- "DB8500 thermal shutdown"};
- static const char * const turn_on_status[] = {
- "Battery rising (Vbat)",
- "Power On Key 1 dbF",
- "Power On Key 2 dbF",
- "RTC Alarm",
- "Main Charger Detect",
- "Vbus Detect (USB)",
- "USB ID Detect",
- "UART Factory Mode Detect"};
- const struct platform_device_id *platid = platform_get_device_id(pdev);
- enum ab8500_version version = AB8500_VERSION_UNDEFINED;
- struct device_node *np = pdev->dev.of_node;
- struct ab8500 *ab8500;
- struct resource *resource;
- int ret;
- int i;
- u8 value;
- ab8500 = devm_kzalloc(&pdev->dev, sizeof(*ab8500), GFP_KERNEL);
- if (!ab8500)
- return -ENOMEM;
- ab8500->dev = &pdev->dev;
- resource = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
- if (!resource) {
- dev_err(&pdev->dev, "no IRQ resource\n");
- return -ENODEV;
- }
- ab8500->irq = resource->start;
- ab8500->read = ab8500_prcmu_read;
- ab8500->write = ab8500_prcmu_write;
- ab8500->write_masked = ab8500_prcmu_write_masked;
- mutex_init(&ab8500->lock);
- mutex_init(&ab8500->irq_lock);
- atomic_set(&ab8500->transfer_ongoing, 0);
- platform_set_drvdata(pdev, ab8500);
- if (platid)
- version = platid->driver_data;
- if (version != AB8500_VERSION_UNDEFINED)
- ab8500->version = version;
- else {
- ret = get_register_interruptible(ab8500, AB8500_MISC,
- AB8500_IC_NAME_REG, &value);
- if (ret < 0) {
- dev_err(&pdev->dev, "could not probe HW\n");
- return ret;
- }
- ab8500->version = value;
- }
- ret = get_register_interruptible(ab8500, AB8500_MISC,
- AB8500_REV_REG, &value);
- if (ret < 0)
- return ret;
- ab8500->chip_id = value;
- dev_info(ab8500->dev, "detected chip, %s rev. %1x.%1x\n",
- ab8500_version_str[ab8500->version],
- ab8500->chip_id >> 4,
- ab8500->chip_id & 0x0F);
- /* Configure AB8540 */
- if (is_ab8540(ab8500)) {
- ab8500->mask_size = AB8540_NUM_IRQ_REGS;
- ab8500->irq_reg_offset = ab8540_irq_regoffset;
- ab8500->it_latchhier_num = AB8540_IT_LATCHHIER_NUM;
- } /* Configure AB8500 or AB9540 IRQ */
- else if (is_ab9540(ab8500) || is_ab8505(ab8500)) {
- ab8500->mask_size = AB9540_NUM_IRQ_REGS;
- ab8500->irq_reg_offset = ab9540_irq_regoffset;
- ab8500->it_latchhier_num = AB8500_IT_LATCHHIER_NUM;
- } else {
- ab8500->mask_size = AB8500_NUM_IRQ_REGS;
- ab8500->irq_reg_offset = ab8500_irq_regoffset;
- ab8500->it_latchhier_num = AB8500_IT_LATCHHIER_NUM;
- }
- ab8500->mask = devm_kzalloc(&pdev->dev, ab8500->mask_size,
- GFP_KERNEL);
- if (!ab8500->mask)
- return -ENOMEM;
- ab8500->oldmask = devm_kzalloc(&pdev->dev, ab8500->mask_size,
- GFP_KERNEL);
- if (!ab8500->oldmask)
- return -ENOMEM;
- /*
- * ab8500 has switched off due to (SWITCH_OFF_STATUS):
- * 0x01 Swoff bit programming
- * 0x02 Thermal protection activation
- * 0x04 Vbat lower then BattOk falling threshold
- * 0x08 Watchdog expired
- * 0x10 Non presence of 32kHz clock
- * 0x20 Battery level lower than power on reset threshold
- * 0x40 Power on key 1 pressed longer than 10 seconds
- * 0x80 DB8500 thermal shutdown
- */
- ret = get_register_interruptible(ab8500, AB8500_RTC,
- AB8500_SWITCH_OFF_STATUS, &value);
- if (ret < 0)
- return ret;
- dev_info(ab8500->dev, "switch off cause(s) (%#x): ", value);
- if (value) {
- for (i = 0; i < ARRAY_SIZE(switch_off_status); i++) {
- if (value & 1)
- pr_cont(" \"%s\"", switch_off_status[i]);
- value = value >> 1;
- }
- pr_cont("\n");
- } else {
- pr_cont(" None\n");
- }
- ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
- AB8500_TURN_ON_STATUS, &value);
- if (ret < 0)
- return ret;
- dev_info(ab8500->dev, "turn on reason(s) (%#x): ", value);
- if (value) {
- for (i = 0; i < ARRAY_SIZE(turn_on_status); i++) {
- if (value & 1)
- pr_cont("\"%s\" ", turn_on_status[i]);
- value = value >> 1;
- }
- pr_cont("\n");
- } else {
- pr_cont("None\n");
- }
- if (is_ab9540(ab8500)) {
- ret = get_register_interruptible(ab8500, AB8500_CHARGER,
- AB8500_CH_USBCH_STAT1_REG, &value);
- if (ret < 0)
- return ret;
- if ((value & VBUS_DET_DBNC1) && (value & VBUS_DET_DBNC100))
- ab8500_override_turn_on_stat(~AB8500_POW_KEY_1_ON,
- AB8500_VBUS_DET);
- }
- /* Clear and mask all interrupts */
- for (i = 0; i < ab8500->mask_size; i++) {
- /*
- * Interrupt register 12 doesn't exist prior to AB8500 version
- * 2.0
- */
- if (ab8500->irq_reg_offset[i] == 11 &&
- is_ab8500_1p1_or_earlier(ab8500))
- continue;
- if (ab8500->irq_reg_offset[i] < 0)
- continue;
- get_register_interruptible(ab8500, AB8500_INTERRUPT,
- AB8500_IT_LATCH1_REG + ab8500->irq_reg_offset[i],
- &value);
- set_register_interruptible(ab8500, AB8500_INTERRUPT,
- AB8500_IT_MASK1_REG + ab8500->irq_reg_offset[i], 0xff);
- }
- ret = abx500_register_ops(ab8500->dev, &ab8500_ops);
- if (ret)
- return ret;
- for (i = 0; i < ab8500->mask_size; i++)
- ab8500->mask[i] = ab8500->oldmask[i] = 0xff;
- ret = ab8500_irq_init(ab8500, np);
- if (ret)
- return ret;
- ret = devm_request_threaded_irq(&pdev->dev, ab8500->irq, NULL,
- ab8500_hierarchical_irq,
- IRQF_ONESHOT | IRQF_NO_SUSPEND,
- "ab8500", ab8500);
- if (ret)
- return ret;
- if (is_ab9540(ab8500))
- ret = mfd_add_devices(ab8500->dev, 0, ab9540_devs,
- ARRAY_SIZE(ab9540_devs), NULL,
- 0, ab8500->domain);
- else if (is_ab8540(ab8500)) {
- ret = mfd_add_devices(ab8500->dev, 0, ab8540_devs,
- ARRAY_SIZE(ab8540_devs), NULL,
- 0, ab8500->domain);
- if (ret)
- return ret;
- if (is_ab8540_1p2_or_earlier(ab8500))
- ret = mfd_add_devices(ab8500->dev, 0, ab8540_cut1_devs,
- ARRAY_SIZE(ab8540_cut1_devs), NULL,
- 0, ab8500->domain);
- else /* ab8540 >= cut2 */
- ret = mfd_add_devices(ab8500->dev, 0, ab8540_cut2_devs,
- ARRAY_SIZE(ab8540_cut2_devs), NULL,
- 0, ab8500->domain);
- } else if (is_ab8505(ab8500))
- ret = mfd_add_devices(ab8500->dev, 0, ab8505_devs,
- ARRAY_SIZE(ab8505_devs), NULL,
- 0, ab8500->domain);
- else
- ret = mfd_add_devices(ab8500->dev, 0, ab8500_devs,
- ARRAY_SIZE(ab8500_devs), NULL,
- 0, ab8500->domain);
- if (ret)
- return ret;
- if (!no_bm) {
- /* Add battery management devices */
- ret = mfd_add_devices(ab8500->dev, 0, ab8500_bm_devs,
- ARRAY_SIZE(ab8500_bm_devs), NULL,
- 0, ab8500->domain);
- if (ret)
- dev_err(ab8500->dev, "error adding bm devices\n");
- }
- if (((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
- ab8500->chip_id >= AB8500_CUT2P0) || is_ab8540(ab8500))
- ret = sysfs_create_group(&ab8500->dev->kobj,
- &ab9540_attr_group);
- else
- ret = sysfs_create_group(&ab8500->dev->kobj,
- &ab8500_attr_group);
- if ((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
- ab8500->chip_id >= AB8500_CUT2P0)
- ret = sysfs_create_group(&ab8500->dev->kobj,
- &ab8505_attr_group);
- if (ret)
- dev_err(ab8500->dev, "error creating sysfs entries\n");
- return ret;
- }
- static int ab8500_remove(struct platform_device *pdev)
- {
- struct ab8500 *ab8500 = platform_get_drvdata(pdev);
- if (((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
- ab8500->chip_id >= AB8500_CUT2P0) || is_ab8540(ab8500))
- sysfs_remove_group(&ab8500->dev->kobj, &ab9540_attr_group);
- else
- sysfs_remove_group(&ab8500->dev->kobj, &ab8500_attr_group);
- if ((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
- ab8500->chip_id >= AB8500_CUT2P0)
- sysfs_remove_group(&ab8500->dev->kobj, &ab8505_attr_group);
- mfd_remove_devices(ab8500->dev);
- return 0;
- }
- static const struct platform_device_id ab8500_id[] = {
- { "ab8500-core", AB8500_VERSION_AB8500 },
- { "ab8505-i2c", AB8500_VERSION_AB8505 },
- { "ab9540-i2c", AB8500_VERSION_AB9540 },
- { "ab8540-i2c", AB8500_VERSION_AB8540 },
- { }
- };
- static struct platform_driver ab8500_core_driver = {
- .driver = {
- .name = "ab8500-core",
- },
- .probe = ab8500_probe,
- .remove = ab8500_remove,
- .id_table = ab8500_id,
- };
- static int __init ab8500_core_init(void)
- {
- return platform_driver_register(&ab8500_core_driver);
- }
- static void __exit ab8500_core_exit(void)
- {
- platform_driver_unregister(&ab8500_core_driver);
- }
- core_initcall(ab8500_core_init);
- module_exit(ab8500_core_exit);
- MODULE_AUTHOR("Mattias Wallin, Srinidhi Kasagar, Rabin Vincent");
- MODULE_DESCRIPTION("AB8500 MFD core");
- MODULE_LICENSE("GPL v2");
|