16dfd10375
The driver always checks for pdata being NULL except in one place. Add a check to prevent a possible NULL pointer deference error. Signed-off-by: Javier Martinez Canillas <javier@osg.samsung.com> Acked-by: Charles Keepax <ckeepax@opensource.wolfsonmicro.com> Signed-off-by: Lee Jones <lee.jones@linaro.org>
1939 lines
42 KiB
C
1939 lines
42 KiB
C
/*
|
|
* wm831x-core.c -- Device access for Wolfson WM831x PMICs
|
|
*
|
|
* Copyright 2009 Wolfson Microelectronics PLC.
|
|
*
|
|
* Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms of the GNU General Public License as published by the
|
|
* Free Software Foundation; either version 2 of the License, or (at your
|
|
* option) any later version.
|
|
*
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/bcd.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/mfd/core.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/err.h>
|
|
|
|
#include <linux/mfd/wm831x/core.h>
|
|
#include <linux/mfd/wm831x/pdata.h>
|
|
#include <linux/mfd/wm831x/irq.h>
|
|
#include <linux/mfd/wm831x/auxadc.h>
|
|
#include <linux/mfd/wm831x/otp.h>
|
|
#include <linux/mfd/wm831x/pmu.h>
|
|
#include <linux/mfd/wm831x/regulator.h>
|
|
|
|
/* Current settings - values are 2*2^(reg_val/4) microamps. These are
|
|
* exported since they are used by multiple drivers.
|
|
*/
|
|
int wm831x_isinkv_values[WM831X_ISINK_MAX_ISEL + 1] = {
|
|
2,
|
|
2,
|
|
3,
|
|
3,
|
|
4,
|
|
5,
|
|
6,
|
|
7,
|
|
8,
|
|
10,
|
|
11,
|
|
13,
|
|
16,
|
|
19,
|
|
23,
|
|
27,
|
|
32,
|
|
38,
|
|
45,
|
|
54,
|
|
64,
|
|
76,
|
|
91,
|
|
108,
|
|
128,
|
|
152,
|
|
181,
|
|
215,
|
|
256,
|
|
304,
|
|
362,
|
|
431,
|
|
512,
|
|
609,
|
|
724,
|
|
861,
|
|
1024,
|
|
1218,
|
|
1448,
|
|
1722,
|
|
2048,
|
|
2435,
|
|
2896,
|
|
3444,
|
|
4096,
|
|
4871,
|
|
5793,
|
|
6889,
|
|
8192,
|
|
9742,
|
|
11585,
|
|
13777,
|
|
16384,
|
|
19484,
|
|
23170,
|
|
27554,
|
|
};
|
|
EXPORT_SYMBOL_GPL(wm831x_isinkv_values);
|
|
|
|
static int wm831x_reg_locked(struct wm831x *wm831x, unsigned short reg)
|
|
{
|
|
if (!wm831x->locked)
|
|
return 0;
|
|
|
|
switch (reg) {
|
|
case WM831X_WATCHDOG:
|
|
case WM831X_DC4_CONTROL:
|
|
case WM831X_ON_PIN_CONTROL:
|
|
case WM831X_BACKUP_CHARGER_CONTROL:
|
|
case WM831X_CHARGER_CONTROL_1:
|
|
case WM831X_CHARGER_CONTROL_2:
|
|
return 1;
|
|
|
|
default:
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* wm831x_reg_unlock: Unlock user keyed registers
|
|
*
|
|
* The WM831x has a user key preventing writes to particularly
|
|
* critical registers. This function locks those registers,
|
|
* allowing writes to them.
|
|
*/
|
|
void wm831x_reg_lock(struct wm831x *wm831x)
|
|
{
|
|
int ret;
|
|
|
|
ret = wm831x_reg_write(wm831x, WM831X_SECURITY_KEY, 0);
|
|
if (ret == 0) {
|
|
dev_vdbg(wm831x->dev, "Registers locked\n");
|
|
|
|
mutex_lock(&wm831x->io_lock);
|
|
WARN_ON(wm831x->locked);
|
|
wm831x->locked = 1;
|
|
mutex_unlock(&wm831x->io_lock);
|
|
} else {
|
|
dev_err(wm831x->dev, "Failed to lock registers: %d\n", ret);
|
|
}
|
|
|
|
}
|
|
EXPORT_SYMBOL_GPL(wm831x_reg_lock);
|
|
|
|
/**
|
|
* wm831x_reg_unlock: Unlock user keyed registers
|
|
*
|
|
* The WM831x has a user key preventing writes to particularly
|
|
* critical registers. This function locks those registers,
|
|
* preventing spurious writes.
|
|
*/
|
|
int wm831x_reg_unlock(struct wm831x *wm831x)
|
|
{
|
|
int ret;
|
|
|
|
/* 0x9716 is the value required to unlock the registers */
|
|
ret = wm831x_reg_write(wm831x, WM831X_SECURITY_KEY, 0x9716);
|
|
if (ret == 0) {
|
|
dev_vdbg(wm831x->dev, "Registers unlocked\n");
|
|
|
|
mutex_lock(&wm831x->io_lock);
|
|
WARN_ON(!wm831x->locked);
|
|
wm831x->locked = 0;
|
|
mutex_unlock(&wm831x->io_lock);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(wm831x_reg_unlock);
|
|
|
|
static bool wm831x_reg_readable(struct device *dev, unsigned int reg)
|
|
{
|
|
switch (reg) {
|
|
case WM831X_RESET_ID:
|
|
case WM831X_REVISION:
|
|
case WM831X_PARENT_ID:
|
|
case WM831X_SYSVDD_CONTROL:
|
|
case WM831X_THERMAL_MONITORING:
|
|
case WM831X_POWER_STATE:
|
|
case WM831X_WATCHDOG:
|
|
case WM831X_ON_PIN_CONTROL:
|
|
case WM831X_RESET_CONTROL:
|
|
case WM831X_CONTROL_INTERFACE:
|
|
case WM831X_SECURITY_KEY:
|
|
case WM831X_SOFTWARE_SCRATCH:
|
|
case WM831X_OTP_CONTROL:
|
|
case WM831X_GPIO_LEVEL:
|
|
case WM831X_SYSTEM_STATUS:
|
|
case WM831X_ON_SOURCE:
|
|
case WM831X_OFF_SOURCE:
|
|
case WM831X_SYSTEM_INTERRUPTS:
|
|
case WM831X_INTERRUPT_STATUS_1:
|
|
case WM831X_INTERRUPT_STATUS_2:
|
|
case WM831X_INTERRUPT_STATUS_3:
|
|
case WM831X_INTERRUPT_STATUS_4:
|
|
case WM831X_INTERRUPT_STATUS_5:
|
|
case WM831X_IRQ_CONFIG:
|
|
case WM831X_SYSTEM_INTERRUPTS_MASK:
|
|
case WM831X_INTERRUPT_STATUS_1_MASK:
|
|
case WM831X_INTERRUPT_STATUS_2_MASK:
|
|
case WM831X_INTERRUPT_STATUS_3_MASK:
|
|
case WM831X_INTERRUPT_STATUS_4_MASK:
|
|
case WM831X_INTERRUPT_STATUS_5_MASK:
|
|
case WM831X_RTC_WRITE_COUNTER:
|
|
case WM831X_RTC_TIME_1:
|
|
case WM831X_RTC_TIME_2:
|
|
case WM831X_RTC_ALARM_1:
|
|
case WM831X_RTC_ALARM_2:
|
|
case WM831X_RTC_CONTROL:
|
|
case WM831X_RTC_TRIM:
|
|
case WM831X_TOUCH_CONTROL_1:
|
|
case WM831X_TOUCH_CONTROL_2:
|
|
case WM831X_TOUCH_DATA_X:
|
|
case WM831X_TOUCH_DATA_Y:
|
|
case WM831X_TOUCH_DATA_Z:
|
|
case WM831X_AUXADC_DATA:
|
|
case WM831X_AUXADC_CONTROL:
|
|
case WM831X_AUXADC_SOURCE:
|
|
case WM831X_COMPARATOR_CONTROL:
|
|
case WM831X_COMPARATOR_1:
|
|
case WM831X_COMPARATOR_2:
|
|
case WM831X_COMPARATOR_3:
|
|
case WM831X_COMPARATOR_4:
|
|
case WM831X_GPIO1_CONTROL:
|
|
case WM831X_GPIO2_CONTROL:
|
|
case WM831X_GPIO3_CONTROL:
|
|
case WM831X_GPIO4_CONTROL:
|
|
case WM831X_GPIO5_CONTROL:
|
|
case WM831X_GPIO6_CONTROL:
|
|
case WM831X_GPIO7_CONTROL:
|
|
case WM831X_GPIO8_CONTROL:
|
|
case WM831X_GPIO9_CONTROL:
|
|
case WM831X_GPIO10_CONTROL:
|
|
case WM831X_GPIO11_CONTROL:
|
|
case WM831X_GPIO12_CONTROL:
|
|
case WM831X_GPIO13_CONTROL:
|
|
case WM831X_GPIO14_CONTROL:
|
|
case WM831X_GPIO15_CONTROL:
|
|
case WM831X_GPIO16_CONTROL:
|
|
case WM831X_CHARGER_CONTROL_1:
|
|
case WM831X_CHARGER_CONTROL_2:
|
|
case WM831X_CHARGER_STATUS:
|
|
case WM831X_BACKUP_CHARGER_CONTROL:
|
|
case WM831X_STATUS_LED_1:
|
|
case WM831X_STATUS_LED_2:
|
|
case WM831X_CURRENT_SINK_1:
|
|
case WM831X_CURRENT_SINK_2:
|
|
case WM831X_DCDC_ENABLE:
|
|
case WM831X_LDO_ENABLE:
|
|
case WM831X_DCDC_STATUS:
|
|
case WM831X_LDO_STATUS:
|
|
case WM831X_DCDC_UV_STATUS:
|
|
case WM831X_LDO_UV_STATUS:
|
|
case WM831X_DC1_CONTROL_1:
|
|
case WM831X_DC1_CONTROL_2:
|
|
case WM831X_DC1_ON_CONFIG:
|
|
case WM831X_DC1_SLEEP_CONTROL:
|
|
case WM831X_DC1_DVS_CONTROL:
|
|
case WM831X_DC2_CONTROL_1:
|
|
case WM831X_DC2_CONTROL_2:
|
|
case WM831X_DC2_ON_CONFIG:
|
|
case WM831X_DC2_SLEEP_CONTROL:
|
|
case WM831X_DC2_DVS_CONTROL:
|
|
case WM831X_DC3_CONTROL_1:
|
|
case WM831X_DC3_CONTROL_2:
|
|
case WM831X_DC3_ON_CONFIG:
|
|
case WM831X_DC3_SLEEP_CONTROL:
|
|
case WM831X_DC4_CONTROL:
|
|
case WM831X_DC4_SLEEP_CONTROL:
|
|
case WM831X_EPE1_CONTROL:
|
|
case WM831X_EPE2_CONTROL:
|
|
case WM831X_LDO1_CONTROL:
|
|
case WM831X_LDO1_ON_CONTROL:
|
|
case WM831X_LDO1_SLEEP_CONTROL:
|
|
case WM831X_LDO2_CONTROL:
|
|
case WM831X_LDO2_ON_CONTROL:
|
|
case WM831X_LDO2_SLEEP_CONTROL:
|
|
case WM831X_LDO3_CONTROL:
|
|
case WM831X_LDO3_ON_CONTROL:
|
|
case WM831X_LDO3_SLEEP_CONTROL:
|
|
case WM831X_LDO4_CONTROL:
|
|
case WM831X_LDO4_ON_CONTROL:
|
|
case WM831X_LDO4_SLEEP_CONTROL:
|
|
case WM831X_LDO5_CONTROL:
|
|
case WM831X_LDO5_ON_CONTROL:
|
|
case WM831X_LDO5_SLEEP_CONTROL:
|
|
case WM831X_LDO6_CONTROL:
|
|
case WM831X_LDO6_ON_CONTROL:
|
|
case WM831X_LDO6_SLEEP_CONTROL:
|
|
case WM831X_LDO7_CONTROL:
|
|
case WM831X_LDO7_ON_CONTROL:
|
|
case WM831X_LDO7_SLEEP_CONTROL:
|
|
case WM831X_LDO8_CONTROL:
|
|
case WM831X_LDO8_ON_CONTROL:
|
|
case WM831X_LDO8_SLEEP_CONTROL:
|
|
case WM831X_LDO9_CONTROL:
|
|
case WM831X_LDO9_ON_CONTROL:
|
|
case WM831X_LDO9_SLEEP_CONTROL:
|
|
case WM831X_LDO10_CONTROL:
|
|
case WM831X_LDO10_ON_CONTROL:
|
|
case WM831X_LDO10_SLEEP_CONTROL:
|
|
case WM831X_LDO11_ON_CONTROL:
|
|
case WM831X_LDO11_SLEEP_CONTROL:
|
|
case WM831X_POWER_GOOD_SOURCE_1:
|
|
case WM831X_POWER_GOOD_SOURCE_2:
|
|
case WM831X_CLOCK_CONTROL_1:
|
|
case WM831X_CLOCK_CONTROL_2:
|
|
case WM831X_FLL_CONTROL_1:
|
|
case WM831X_FLL_CONTROL_2:
|
|
case WM831X_FLL_CONTROL_3:
|
|
case WM831X_FLL_CONTROL_4:
|
|
case WM831X_FLL_CONTROL_5:
|
|
case WM831X_UNIQUE_ID_1:
|
|
case WM831X_UNIQUE_ID_2:
|
|
case WM831X_UNIQUE_ID_3:
|
|
case WM831X_UNIQUE_ID_4:
|
|
case WM831X_UNIQUE_ID_5:
|
|
case WM831X_UNIQUE_ID_6:
|
|
case WM831X_UNIQUE_ID_7:
|
|
case WM831X_UNIQUE_ID_8:
|
|
case WM831X_FACTORY_OTP_ID:
|
|
case WM831X_FACTORY_OTP_1:
|
|
case WM831X_FACTORY_OTP_2:
|
|
case WM831X_FACTORY_OTP_3:
|
|
case WM831X_FACTORY_OTP_4:
|
|
case WM831X_FACTORY_OTP_5:
|
|
case WM831X_CUSTOMER_OTP_ID:
|
|
case WM831X_DC1_OTP_CONTROL:
|
|
case WM831X_DC2_OTP_CONTROL:
|
|
case WM831X_DC3_OTP_CONTROL:
|
|
case WM831X_LDO1_2_OTP_CONTROL:
|
|
case WM831X_LDO3_4_OTP_CONTROL:
|
|
case WM831X_LDO5_6_OTP_CONTROL:
|
|
case WM831X_LDO7_8_OTP_CONTROL:
|
|
case WM831X_LDO9_10_OTP_CONTROL:
|
|
case WM831X_LDO11_EPE_CONTROL:
|
|
case WM831X_GPIO1_OTP_CONTROL:
|
|
case WM831X_GPIO2_OTP_CONTROL:
|
|
case WM831X_GPIO3_OTP_CONTROL:
|
|
case WM831X_GPIO4_OTP_CONTROL:
|
|
case WM831X_GPIO5_OTP_CONTROL:
|
|
case WM831X_GPIO6_OTP_CONTROL:
|
|
case WM831X_DBE_CHECK_DATA:
|
|
return true;
|
|
default:
|
|
return false;
|
|
}
|
|
}
|
|
|
|
static bool wm831x_reg_writeable(struct device *dev, unsigned int reg)
|
|
{
|
|
struct wm831x *wm831x = dev_get_drvdata(dev);
|
|
|
|
if (wm831x_reg_locked(wm831x, reg))
|
|
return false;
|
|
|
|
switch (reg) {
|
|
case WM831X_SYSVDD_CONTROL:
|
|
case WM831X_THERMAL_MONITORING:
|
|
case WM831X_POWER_STATE:
|
|
case WM831X_WATCHDOG:
|
|
case WM831X_ON_PIN_CONTROL:
|
|
case WM831X_RESET_CONTROL:
|
|
case WM831X_CONTROL_INTERFACE:
|
|
case WM831X_SECURITY_KEY:
|
|
case WM831X_SOFTWARE_SCRATCH:
|
|
case WM831X_OTP_CONTROL:
|
|
case WM831X_GPIO_LEVEL:
|
|
case WM831X_INTERRUPT_STATUS_1:
|
|
case WM831X_INTERRUPT_STATUS_2:
|
|
case WM831X_INTERRUPT_STATUS_3:
|
|
case WM831X_INTERRUPT_STATUS_4:
|
|
case WM831X_INTERRUPT_STATUS_5:
|
|
case WM831X_IRQ_CONFIG:
|
|
case WM831X_SYSTEM_INTERRUPTS_MASK:
|
|
case WM831X_INTERRUPT_STATUS_1_MASK:
|
|
case WM831X_INTERRUPT_STATUS_2_MASK:
|
|
case WM831X_INTERRUPT_STATUS_3_MASK:
|
|
case WM831X_INTERRUPT_STATUS_4_MASK:
|
|
case WM831X_INTERRUPT_STATUS_5_MASK:
|
|
case WM831X_RTC_TIME_1:
|
|
case WM831X_RTC_TIME_2:
|
|
case WM831X_RTC_ALARM_1:
|
|
case WM831X_RTC_ALARM_2:
|
|
case WM831X_RTC_CONTROL:
|
|
case WM831X_RTC_TRIM:
|
|
case WM831X_TOUCH_CONTROL_1:
|
|
case WM831X_TOUCH_CONTROL_2:
|
|
case WM831X_AUXADC_CONTROL:
|
|
case WM831X_AUXADC_SOURCE:
|
|
case WM831X_COMPARATOR_CONTROL:
|
|
case WM831X_COMPARATOR_1:
|
|
case WM831X_COMPARATOR_2:
|
|
case WM831X_COMPARATOR_3:
|
|
case WM831X_COMPARATOR_4:
|
|
case WM831X_GPIO1_CONTROL:
|
|
case WM831X_GPIO2_CONTROL:
|
|
case WM831X_GPIO3_CONTROL:
|
|
case WM831X_GPIO4_CONTROL:
|
|
case WM831X_GPIO5_CONTROL:
|
|
case WM831X_GPIO6_CONTROL:
|
|
case WM831X_GPIO7_CONTROL:
|
|
case WM831X_GPIO8_CONTROL:
|
|
case WM831X_GPIO9_CONTROL:
|
|
case WM831X_GPIO10_CONTROL:
|
|
case WM831X_GPIO11_CONTROL:
|
|
case WM831X_GPIO12_CONTROL:
|
|
case WM831X_GPIO13_CONTROL:
|
|
case WM831X_GPIO14_CONTROL:
|
|
case WM831X_GPIO15_CONTROL:
|
|
case WM831X_GPIO16_CONTROL:
|
|
case WM831X_CHARGER_CONTROL_1:
|
|
case WM831X_CHARGER_CONTROL_2:
|
|
case WM831X_CHARGER_STATUS:
|
|
case WM831X_BACKUP_CHARGER_CONTROL:
|
|
case WM831X_STATUS_LED_1:
|
|
case WM831X_STATUS_LED_2:
|
|
case WM831X_CURRENT_SINK_1:
|
|
case WM831X_CURRENT_SINK_2:
|
|
case WM831X_DCDC_ENABLE:
|
|
case WM831X_LDO_ENABLE:
|
|
case WM831X_DC1_CONTROL_1:
|
|
case WM831X_DC1_CONTROL_2:
|
|
case WM831X_DC1_ON_CONFIG:
|
|
case WM831X_DC1_SLEEP_CONTROL:
|
|
case WM831X_DC1_DVS_CONTROL:
|
|
case WM831X_DC2_CONTROL_1:
|
|
case WM831X_DC2_CONTROL_2:
|
|
case WM831X_DC2_ON_CONFIG:
|
|
case WM831X_DC2_SLEEP_CONTROL:
|
|
case WM831X_DC2_DVS_CONTROL:
|
|
case WM831X_DC3_CONTROL_1:
|
|
case WM831X_DC3_CONTROL_2:
|
|
case WM831X_DC3_ON_CONFIG:
|
|
case WM831X_DC3_SLEEP_CONTROL:
|
|
case WM831X_DC4_CONTROL:
|
|
case WM831X_DC4_SLEEP_CONTROL:
|
|
case WM831X_EPE1_CONTROL:
|
|
case WM831X_EPE2_CONTROL:
|
|
case WM831X_LDO1_CONTROL:
|
|
case WM831X_LDO1_ON_CONTROL:
|
|
case WM831X_LDO1_SLEEP_CONTROL:
|
|
case WM831X_LDO2_CONTROL:
|
|
case WM831X_LDO2_ON_CONTROL:
|
|
case WM831X_LDO2_SLEEP_CONTROL:
|
|
case WM831X_LDO3_CONTROL:
|
|
case WM831X_LDO3_ON_CONTROL:
|
|
case WM831X_LDO3_SLEEP_CONTROL:
|
|
case WM831X_LDO4_CONTROL:
|
|
case WM831X_LDO4_ON_CONTROL:
|
|
case WM831X_LDO4_SLEEP_CONTROL:
|
|
case WM831X_LDO5_CONTROL:
|
|
case WM831X_LDO5_ON_CONTROL:
|
|
case WM831X_LDO5_SLEEP_CONTROL:
|
|
case WM831X_LDO6_CONTROL:
|
|
case WM831X_LDO6_ON_CONTROL:
|
|
case WM831X_LDO6_SLEEP_CONTROL:
|
|
case WM831X_LDO7_CONTROL:
|
|
case WM831X_LDO7_ON_CONTROL:
|
|
case WM831X_LDO7_SLEEP_CONTROL:
|
|
case WM831X_LDO8_CONTROL:
|
|
case WM831X_LDO8_ON_CONTROL:
|
|
case WM831X_LDO8_SLEEP_CONTROL:
|
|
case WM831X_LDO9_CONTROL:
|
|
case WM831X_LDO9_ON_CONTROL:
|
|
case WM831X_LDO9_SLEEP_CONTROL:
|
|
case WM831X_LDO10_CONTROL:
|
|
case WM831X_LDO10_ON_CONTROL:
|
|
case WM831X_LDO10_SLEEP_CONTROL:
|
|
case WM831X_LDO11_ON_CONTROL:
|
|
case WM831X_LDO11_SLEEP_CONTROL:
|
|
case WM831X_POWER_GOOD_SOURCE_1:
|
|
case WM831X_POWER_GOOD_SOURCE_2:
|
|
case WM831X_CLOCK_CONTROL_1:
|
|
case WM831X_CLOCK_CONTROL_2:
|
|
case WM831X_FLL_CONTROL_1:
|
|
case WM831X_FLL_CONTROL_2:
|
|
case WM831X_FLL_CONTROL_3:
|
|
case WM831X_FLL_CONTROL_4:
|
|
case WM831X_FLL_CONTROL_5:
|
|
return true;
|
|
default:
|
|
return false;
|
|
}
|
|
}
|
|
|
|
static bool wm831x_reg_volatile(struct device *dev, unsigned int reg)
|
|
{
|
|
switch (reg) {
|
|
case WM831X_SYSTEM_STATUS:
|
|
case WM831X_ON_SOURCE:
|
|
case WM831X_OFF_SOURCE:
|
|
case WM831X_GPIO_LEVEL:
|
|
case WM831X_SYSTEM_INTERRUPTS:
|
|
case WM831X_INTERRUPT_STATUS_1:
|
|
case WM831X_INTERRUPT_STATUS_2:
|
|
case WM831X_INTERRUPT_STATUS_3:
|
|
case WM831X_INTERRUPT_STATUS_4:
|
|
case WM831X_INTERRUPT_STATUS_5:
|
|
case WM831X_RTC_TIME_1:
|
|
case WM831X_RTC_TIME_2:
|
|
case WM831X_TOUCH_DATA_X:
|
|
case WM831X_TOUCH_DATA_Y:
|
|
case WM831X_TOUCH_DATA_Z:
|
|
case WM831X_AUXADC_DATA:
|
|
case WM831X_CHARGER_STATUS:
|
|
case WM831X_DCDC_STATUS:
|
|
case WM831X_LDO_STATUS:
|
|
case WM831X_DCDC_UV_STATUS:
|
|
case WM831X_LDO_UV_STATUS:
|
|
return true;
|
|
default:
|
|
return false;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* wm831x_reg_read: Read a single WM831x register.
|
|
*
|
|
* @wm831x: Device to read from.
|
|
* @reg: Register to read.
|
|
*/
|
|
int wm831x_reg_read(struct wm831x *wm831x, unsigned short reg)
|
|
{
|
|
unsigned int val;
|
|
int ret;
|
|
|
|
ret = regmap_read(wm831x->regmap, reg, &val);
|
|
|
|
if (ret < 0)
|
|
return ret;
|
|
else
|
|
return val;
|
|
}
|
|
EXPORT_SYMBOL_GPL(wm831x_reg_read);
|
|
|
|
/**
|
|
* wm831x_bulk_read: Read multiple WM831x registers
|
|
*
|
|
* @wm831x: Device to read from
|
|
* @reg: First register
|
|
* @count: Number of registers
|
|
* @buf: Buffer to fill.
|
|
*/
|
|
int wm831x_bulk_read(struct wm831x *wm831x, unsigned short reg,
|
|
int count, u16 *buf)
|
|
{
|
|
return regmap_bulk_read(wm831x->regmap, reg, buf, count);
|
|
}
|
|
EXPORT_SYMBOL_GPL(wm831x_bulk_read);
|
|
|
|
static int wm831x_write(struct wm831x *wm831x, unsigned short reg,
|
|
int bytes, void *src)
|
|
{
|
|
u16 *buf = src;
|
|
int i, ret;
|
|
|
|
BUG_ON(bytes % 2);
|
|
BUG_ON(bytes <= 0);
|
|
|
|
for (i = 0; i < bytes / 2; i++) {
|
|
if (wm831x_reg_locked(wm831x, reg))
|
|
return -EPERM;
|
|
|
|
dev_vdbg(wm831x->dev, "Write %04x to R%d(0x%x)\n",
|
|
buf[i], reg + i, reg + i);
|
|
ret = regmap_write(wm831x->regmap, reg + i, buf[i]);
|
|
if (ret != 0)
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* wm831x_reg_write: Write a single WM831x register.
|
|
*
|
|
* @wm831x: Device to write to.
|
|
* @reg: Register to write to.
|
|
* @val: Value to write.
|
|
*/
|
|
int wm831x_reg_write(struct wm831x *wm831x, unsigned short reg,
|
|
unsigned short val)
|
|
{
|
|
int ret;
|
|
|
|
mutex_lock(&wm831x->io_lock);
|
|
|
|
ret = wm831x_write(wm831x, reg, 2, &val);
|
|
|
|
mutex_unlock(&wm831x->io_lock);
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(wm831x_reg_write);
|
|
|
|
/**
|
|
* wm831x_set_bits: Set the value of a bitfield in a WM831x register
|
|
*
|
|
* @wm831x: Device to write to.
|
|
* @reg: Register to write to.
|
|
* @mask: Mask of bits to set.
|
|
* @val: Value to set (unshifted)
|
|
*/
|
|
int wm831x_set_bits(struct wm831x *wm831x, unsigned short reg,
|
|
unsigned short mask, unsigned short val)
|
|
{
|
|
int ret;
|
|
|
|
mutex_lock(&wm831x->io_lock);
|
|
|
|
if (!wm831x_reg_locked(wm831x, reg))
|
|
ret = regmap_update_bits(wm831x->regmap, reg, mask, val);
|
|
else
|
|
ret = -EPERM;
|
|
|
|
mutex_unlock(&wm831x->io_lock);
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(wm831x_set_bits);
|
|
|
|
static struct resource wm831x_dcdc1_resources[] = {
|
|
{
|
|
.start = WM831X_DC1_CONTROL_1,
|
|
.end = WM831X_DC1_DVS_CONTROL,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_DC1,
|
|
.end = WM831X_IRQ_UV_DC1,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "HC",
|
|
.start = WM831X_IRQ_HC_DC1,
|
|
.end = WM831X_IRQ_HC_DC1,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
|
|
static struct resource wm831x_dcdc2_resources[] = {
|
|
{
|
|
.start = WM831X_DC2_CONTROL_1,
|
|
.end = WM831X_DC2_DVS_CONTROL,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_DC2,
|
|
.end = WM831X_IRQ_UV_DC2,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "HC",
|
|
.start = WM831X_IRQ_HC_DC2,
|
|
.end = WM831X_IRQ_HC_DC2,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_dcdc3_resources[] = {
|
|
{
|
|
.start = WM831X_DC3_CONTROL_1,
|
|
.end = WM831X_DC3_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_DC3,
|
|
.end = WM831X_IRQ_UV_DC3,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_dcdc4_resources[] = {
|
|
{
|
|
.start = WM831X_DC4_CONTROL,
|
|
.end = WM831X_DC4_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_DC4,
|
|
.end = WM831X_IRQ_UV_DC4,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm8320_dcdc4_buck_resources[] = {
|
|
{
|
|
.start = WM831X_DC4_CONTROL,
|
|
.end = WM832X_DC4_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_DC4,
|
|
.end = WM831X_IRQ_UV_DC4,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_gpio_resources[] = {
|
|
{
|
|
.start = WM831X_IRQ_GPIO_1,
|
|
.end = WM831X_IRQ_GPIO_16,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_isink1_resources[] = {
|
|
{
|
|
.start = WM831X_CURRENT_SINK_1,
|
|
.end = WM831X_CURRENT_SINK_1,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
{
|
|
.start = WM831X_IRQ_CS1,
|
|
.end = WM831X_IRQ_CS1,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_isink2_resources[] = {
|
|
{
|
|
.start = WM831X_CURRENT_SINK_2,
|
|
.end = WM831X_CURRENT_SINK_2,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
{
|
|
.start = WM831X_IRQ_CS2,
|
|
.end = WM831X_IRQ_CS2,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo1_resources[] = {
|
|
{
|
|
.start = WM831X_LDO1_CONTROL,
|
|
.end = WM831X_LDO1_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO1,
|
|
.end = WM831X_IRQ_UV_LDO1,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo2_resources[] = {
|
|
{
|
|
.start = WM831X_LDO2_CONTROL,
|
|
.end = WM831X_LDO2_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO2,
|
|
.end = WM831X_IRQ_UV_LDO2,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo3_resources[] = {
|
|
{
|
|
.start = WM831X_LDO3_CONTROL,
|
|
.end = WM831X_LDO3_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO3,
|
|
.end = WM831X_IRQ_UV_LDO3,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo4_resources[] = {
|
|
{
|
|
.start = WM831X_LDO4_CONTROL,
|
|
.end = WM831X_LDO4_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO4,
|
|
.end = WM831X_IRQ_UV_LDO4,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo5_resources[] = {
|
|
{
|
|
.start = WM831X_LDO5_CONTROL,
|
|
.end = WM831X_LDO5_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO5,
|
|
.end = WM831X_IRQ_UV_LDO5,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo6_resources[] = {
|
|
{
|
|
.start = WM831X_LDO6_CONTROL,
|
|
.end = WM831X_LDO6_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO6,
|
|
.end = WM831X_IRQ_UV_LDO6,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo7_resources[] = {
|
|
{
|
|
.start = WM831X_LDO7_CONTROL,
|
|
.end = WM831X_LDO7_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO7,
|
|
.end = WM831X_IRQ_UV_LDO7,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo8_resources[] = {
|
|
{
|
|
.start = WM831X_LDO8_CONTROL,
|
|
.end = WM831X_LDO8_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO8,
|
|
.end = WM831X_IRQ_UV_LDO8,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo9_resources[] = {
|
|
{
|
|
.start = WM831X_LDO9_CONTROL,
|
|
.end = WM831X_LDO9_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO9,
|
|
.end = WM831X_IRQ_UV_LDO9,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo10_resources[] = {
|
|
{
|
|
.start = WM831X_LDO10_CONTROL,
|
|
.end = WM831X_LDO10_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
{
|
|
.name = "UV",
|
|
.start = WM831X_IRQ_UV_LDO10,
|
|
.end = WM831X_IRQ_UV_LDO10,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_ldo11_resources[] = {
|
|
{
|
|
.start = WM831X_LDO11_ON_CONTROL,
|
|
.end = WM831X_LDO11_SLEEP_CONTROL,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_on_resources[] = {
|
|
{
|
|
.start = WM831X_IRQ_ON,
|
|
.end = WM831X_IRQ_ON,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
|
|
static struct resource wm831x_power_resources[] = {
|
|
{
|
|
.name = "SYSLO",
|
|
.start = WM831X_IRQ_PPM_SYSLO,
|
|
.end = WM831X_IRQ_PPM_SYSLO,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "PWR SRC",
|
|
.start = WM831X_IRQ_PPM_PWR_SRC,
|
|
.end = WM831X_IRQ_PPM_PWR_SRC,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "USB CURR",
|
|
.start = WM831X_IRQ_PPM_USB_CURR,
|
|
.end = WM831X_IRQ_PPM_USB_CURR,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "BATT HOT",
|
|
.start = WM831X_IRQ_CHG_BATT_HOT,
|
|
.end = WM831X_IRQ_CHG_BATT_HOT,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "BATT COLD",
|
|
.start = WM831X_IRQ_CHG_BATT_COLD,
|
|
.end = WM831X_IRQ_CHG_BATT_COLD,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "BATT FAIL",
|
|
.start = WM831X_IRQ_CHG_BATT_FAIL,
|
|
.end = WM831X_IRQ_CHG_BATT_FAIL,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "OV",
|
|
.start = WM831X_IRQ_CHG_OV,
|
|
.end = WM831X_IRQ_CHG_OV,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "END",
|
|
.start = WM831X_IRQ_CHG_END,
|
|
.end = WM831X_IRQ_CHG_END,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "TO",
|
|
.start = WM831X_IRQ_CHG_TO,
|
|
.end = WM831X_IRQ_CHG_TO,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "MODE",
|
|
.start = WM831X_IRQ_CHG_MODE,
|
|
.end = WM831X_IRQ_CHG_MODE,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "START",
|
|
.start = WM831X_IRQ_CHG_START,
|
|
.end = WM831X_IRQ_CHG_START,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_rtc_resources[] = {
|
|
{
|
|
.name = "PER",
|
|
.start = WM831X_IRQ_RTC_PER,
|
|
.end = WM831X_IRQ_RTC_PER,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "ALM",
|
|
.start = WM831X_IRQ_RTC_ALM,
|
|
.end = WM831X_IRQ_RTC_ALM,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_status1_resources[] = {
|
|
{
|
|
.start = WM831X_STATUS_LED_1,
|
|
.end = WM831X_STATUS_LED_1,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_status2_resources[] = {
|
|
{
|
|
.start = WM831X_STATUS_LED_2,
|
|
.end = WM831X_STATUS_LED_2,
|
|
.flags = IORESOURCE_REG,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_touch_resources[] = {
|
|
{
|
|
.name = "TCHPD",
|
|
.start = WM831X_IRQ_TCHPD,
|
|
.end = WM831X_IRQ_TCHPD,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
{
|
|
.name = "TCHDATA",
|
|
.start = WM831X_IRQ_TCHDATA,
|
|
.end = WM831X_IRQ_TCHDATA,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct resource wm831x_wdt_resources[] = {
|
|
{
|
|
.start = WM831X_IRQ_WDOG_TO,
|
|
.end = WM831X_IRQ_WDOG_TO,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static const struct mfd_cell wm8310_devs[] = {
|
|
{
|
|
.name = "wm831x-backup",
|
|
},
|
|
{
|
|
.name = "wm831x-buckv",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc1_resources),
|
|
.resources = wm831x_dcdc1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-buckv",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc2_resources),
|
|
.resources = wm831x_dcdc2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-buckp",
|
|
.id = 3,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc3_resources),
|
|
.resources = wm831x_dcdc3_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-boostp",
|
|
.id = 4,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc4_resources),
|
|
.resources = wm831x_dcdc4_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-clk",
|
|
},
|
|
{
|
|
.name = "wm831x-epe",
|
|
.id = 1,
|
|
},
|
|
{
|
|
.name = "wm831x-epe",
|
|
.id = 2,
|
|
},
|
|
{
|
|
.name = "wm831x-gpio",
|
|
.num_resources = ARRAY_SIZE(wm831x_gpio_resources),
|
|
.resources = wm831x_gpio_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-hwmon",
|
|
},
|
|
{
|
|
.name = "wm831x-isink",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_isink1_resources),
|
|
.resources = wm831x_isink1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-isink",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_isink2_resources),
|
|
.resources = wm831x_isink2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo1_resources),
|
|
.resources = wm831x_ldo1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo2_resources),
|
|
.resources = wm831x_ldo2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 3,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo3_resources),
|
|
.resources = wm831x_ldo3_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 4,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo4_resources),
|
|
.resources = wm831x_ldo4_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 5,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo5_resources),
|
|
.resources = wm831x_ldo5_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 6,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo6_resources),
|
|
.resources = wm831x_ldo6_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 7,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo7_resources),
|
|
.resources = wm831x_ldo7_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 8,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo8_resources),
|
|
.resources = wm831x_ldo8_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 9,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo9_resources),
|
|
.resources = wm831x_ldo9_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 10,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo10_resources),
|
|
.resources = wm831x_ldo10_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-alive-ldo",
|
|
.id = 11,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo11_resources),
|
|
.resources = wm831x_ldo11_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-on",
|
|
.num_resources = ARRAY_SIZE(wm831x_on_resources),
|
|
.resources = wm831x_on_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-power",
|
|
.num_resources = ARRAY_SIZE(wm831x_power_resources),
|
|
.resources = wm831x_power_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-status",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_status1_resources),
|
|
.resources = wm831x_status1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-status",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_status2_resources),
|
|
.resources = wm831x_status2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-watchdog",
|
|
.num_resources = ARRAY_SIZE(wm831x_wdt_resources),
|
|
.resources = wm831x_wdt_resources,
|
|
},
|
|
};
|
|
|
|
static const struct mfd_cell wm8311_devs[] = {
|
|
{
|
|
.name = "wm831x-backup",
|
|
},
|
|
{
|
|
.name = "wm831x-buckv",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc1_resources),
|
|
.resources = wm831x_dcdc1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-buckv",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc2_resources),
|
|
.resources = wm831x_dcdc2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-buckp",
|
|
.id = 3,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc3_resources),
|
|
.resources = wm831x_dcdc3_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-boostp",
|
|
.id = 4,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc4_resources),
|
|
.resources = wm831x_dcdc4_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-clk",
|
|
},
|
|
{
|
|
.name = "wm831x-epe",
|
|
.id = 1,
|
|
},
|
|
{
|
|
.name = "wm831x-epe",
|
|
.id = 2,
|
|
},
|
|
{
|
|
.name = "wm831x-gpio",
|
|
.num_resources = ARRAY_SIZE(wm831x_gpio_resources),
|
|
.resources = wm831x_gpio_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-hwmon",
|
|
},
|
|
{
|
|
.name = "wm831x-isink",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_isink1_resources),
|
|
.resources = wm831x_isink1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-isink",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_isink2_resources),
|
|
.resources = wm831x_isink2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo1_resources),
|
|
.resources = wm831x_ldo1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo2_resources),
|
|
.resources = wm831x_ldo2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 3,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo3_resources),
|
|
.resources = wm831x_ldo3_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 4,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo4_resources),
|
|
.resources = wm831x_ldo4_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 5,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo5_resources),
|
|
.resources = wm831x_ldo5_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 7,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo7_resources),
|
|
.resources = wm831x_ldo7_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-alive-ldo",
|
|
.id = 11,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo11_resources),
|
|
.resources = wm831x_ldo11_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-on",
|
|
.num_resources = ARRAY_SIZE(wm831x_on_resources),
|
|
.resources = wm831x_on_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-power",
|
|
.num_resources = ARRAY_SIZE(wm831x_power_resources),
|
|
.resources = wm831x_power_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-status",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_status1_resources),
|
|
.resources = wm831x_status1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-status",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_status2_resources),
|
|
.resources = wm831x_status2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-watchdog",
|
|
.num_resources = ARRAY_SIZE(wm831x_wdt_resources),
|
|
.resources = wm831x_wdt_resources,
|
|
},
|
|
};
|
|
|
|
static const struct mfd_cell wm8312_devs[] = {
|
|
{
|
|
.name = "wm831x-backup",
|
|
},
|
|
{
|
|
.name = "wm831x-buckv",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc1_resources),
|
|
.resources = wm831x_dcdc1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-buckv",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc2_resources),
|
|
.resources = wm831x_dcdc2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-buckp",
|
|
.id = 3,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc3_resources),
|
|
.resources = wm831x_dcdc3_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-boostp",
|
|
.id = 4,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc4_resources),
|
|
.resources = wm831x_dcdc4_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-clk",
|
|
},
|
|
{
|
|
.name = "wm831x-epe",
|
|
.id = 1,
|
|
},
|
|
{
|
|
.name = "wm831x-epe",
|
|
.id = 2,
|
|
},
|
|
{
|
|
.name = "wm831x-gpio",
|
|
.num_resources = ARRAY_SIZE(wm831x_gpio_resources),
|
|
.resources = wm831x_gpio_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-hwmon",
|
|
},
|
|
{
|
|
.name = "wm831x-isink",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_isink1_resources),
|
|
.resources = wm831x_isink1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-isink",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_isink2_resources),
|
|
.resources = wm831x_isink2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo1_resources),
|
|
.resources = wm831x_ldo1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo2_resources),
|
|
.resources = wm831x_ldo2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 3,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo3_resources),
|
|
.resources = wm831x_ldo3_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 4,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo4_resources),
|
|
.resources = wm831x_ldo4_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 5,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo5_resources),
|
|
.resources = wm831x_ldo5_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 6,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo6_resources),
|
|
.resources = wm831x_ldo6_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 7,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo7_resources),
|
|
.resources = wm831x_ldo7_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 8,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo8_resources),
|
|
.resources = wm831x_ldo8_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 9,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo9_resources),
|
|
.resources = wm831x_ldo9_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 10,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo10_resources),
|
|
.resources = wm831x_ldo10_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-alive-ldo",
|
|
.id = 11,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo11_resources),
|
|
.resources = wm831x_ldo11_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-on",
|
|
.num_resources = ARRAY_SIZE(wm831x_on_resources),
|
|
.resources = wm831x_on_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-power",
|
|
.num_resources = ARRAY_SIZE(wm831x_power_resources),
|
|
.resources = wm831x_power_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-status",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_status1_resources),
|
|
.resources = wm831x_status1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-status",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_status2_resources),
|
|
.resources = wm831x_status2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-watchdog",
|
|
.num_resources = ARRAY_SIZE(wm831x_wdt_resources),
|
|
.resources = wm831x_wdt_resources,
|
|
},
|
|
};
|
|
|
|
static const struct mfd_cell wm8320_devs[] = {
|
|
{
|
|
.name = "wm831x-backup",
|
|
},
|
|
{
|
|
.name = "wm831x-buckv",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc1_resources),
|
|
.resources = wm831x_dcdc1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-buckv",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc2_resources),
|
|
.resources = wm831x_dcdc2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-buckp",
|
|
.id = 3,
|
|
.num_resources = ARRAY_SIZE(wm831x_dcdc3_resources),
|
|
.resources = wm831x_dcdc3_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-buckp",
|
|
.id = 4,
|
|
.num_resources = ARRAY_SIZE(wm8320_dcdc4_buck_resources),
|
|
.resources = wm8320_dcdc4_buck_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-clk",
|
|
},
|
|
{
|
|
.name = "wm831x-gpio",
|
|
.num_resources = ARRAY_SIZE(wm831x_gpio_resources),
|
|
.resources = wm831x_gpio_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-hwmon",
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo1_resources),
|
|
.resources = wm831x_ldo1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo2_resources),
|
|
.resources = wm831x_ldo2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 3,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo3_resources),
|
|
.resources = wm831x_ldo3_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 4,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo4_resources),
|
|
.resources = wm831x_ldo4_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 5,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo5_resources),
|
|
.resources = wm831x_ldo5_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-ldo",
|
|
.id = 6,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo6_resources),
|
|
.resources = wm831x_ldo6_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 7,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo7_resources),
|
|
.resources = wm831x_ldo7_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 8,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo8_resources),
|
|
.resources = wm831x_ldo8_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 9,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo9_resources),
|
|
.resources = wm831x_ldo9_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-aldo",
|
|
.id = 10,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo10_resources),
|
|
.resources = wm831x_ldo10_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-alive-ldo",
|
|
.id = 11,
|
|
.num_resources = ARRAY_SIZE(wm831x_ldo11_resources),
|
|
.resources = wm831x_ldo11_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-on",
|
|
.num_resources = ARRAY_SIZE(wm831x_on_resources),
|
|
.resources = wm831x_on_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-status",
|
|
.id = 1,
|
|
.num_resources = ARRAY_SIZE(wm831x_status1_resources),
|
|
.resources = wm831x_status1_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-status",
|
|
.id = 2,
|
|
.num_resources = ARRAY_SIZE(wm831x_status2_resources),
|
|
.resources = wm831x_status2_resources,
|
|
},
|
|
{
|
|
.name = "wm831x-watchdog",
|
|
.num_resources = ARRAY_SIZE(wm831x_wdt_resources),
|
|
.resources = wm831x_wdt_resources,
|
|
},
|
|
};
|
|
|
|
static const struct mfd_cell touch_devs[] = {
|
|
{
|
|
.name = "wm831x-touch",
|
|
.num_resources = ARRAY_SIZE(wm831x_touch_resources),
|
|
.resources = wm831x_touch_resources,
|
|
},
|
|
};
|
|
|
|
static const struct mfd_cell rtc_devs[] = {
|
|
{
|
|
.name = "wm831x-rtc",
|
|
.num_resources = ARRAY_SIZE(wm831x_rtc_resources),
|
|
.resources = wm831x_rtc_resources,
|
|
},
|
|
};
|
|
|
|
static const struct mfd_cell backlight_devs[] = {
|
|
{
|
|
.name = "wm831x-backlight",
|
|
},
|
|
};
|
|
|
|
struct regmap_config wm831x_regmap_config = {
|
|
.reg_bits = 16,
|
|
.val_bits = 16,
|
|
|
|
.cache_type = REGCACHE_RBTREE,
|
|
|
|
.max_register = WM831X_DBE_CHECK_DATA,
|
|
.readable_reg = wm831x_reg_readable,
|
|
.writeable_reg = wm831x_reg_writeable,
|
|
.volatile_reg = wm831x_reg_volatile,
|
|
};
|
|
EXPORT_SYMBOL_GPL(wm831x_regmap_config);
|
|
|
|
/*
|
|
* Instantiate the generic non-control parts of the device.
|
|
*/
|
|
int wm831x_device_init(struct wm831x *wm831x, unsigned long id, int irq)
|
|
{
|
|
struct wm831x_pdata *pdata = dev_get_platdata(wm831x->dev);
|
|
int rev, wm831x_num;
|
|
enum wm831x_parent parent;
|
|
int ret, i;
|
|
|
|
mutex_init(&wm831x->io_lock);
|
|
mutex_init(&wm831x->key_lock);
|
|
dev_set_drvdata(wm831x->dev, wm831x);
|
|
|
|
if (pdata)
|
|
wm831x->soft_shutdown = pdata->soft_shutdown;
|
|
|
|
ret = wm831x_reg_read(wm831x, WM831X_PARENT_ID);
|
|
if (ret < 0) {
|
|
dev_err(wm831x->dev, "Failed to read parent ID: %d\n", ret);
|
|
goto err;
|
|
}
|
|
switch (ret) {
|
|
case 0x6204:
|
|
case 0x6246:
|
|
break;
|
|
default:
|
|
dev_err(wm831x->dev, "Device is not a WM831x: ID %x\n", ret);
|
|
ret = -EINVAL;
|
|
goto err;
|
|
}
|
|
|
|
ret = wm831x_reg_read(wm831x, WM831X_REVISION);
|
|
if (ret < 0) {
|
|
dev_err(wm831x->dev, "Failed to read revision: %d\n", ret);
|
|
goto err;
|
|
}
|
|
rev = (ret & WM831X_PARENT_REV_MASK) >> WM831X_PARENT_REV_SHIFT;
|
|
|
|
ret = wm831x_reg_read(wm831x, WM831X_RESET_ID);
|
|
if (ret < 0) {
|
|
dev_err(wm831x->dev, "Failed to read device ID: %d\n", ret);
|
|
goto err;
|
|
}
|
|
|
|
/* Some engineering samples do not have the ID set, rely on
|
|
* the device being registered correctly.
|
|
*/
|
|
if (ret == 0) {
|
|
dev_info(wm831x->dev, "Device is an engineering sample\n");
|
|
ret = id;
|
|
}
|
|
|
|
switch (ret) {
|
|
case WM8310:
|
|
parent = WM8310;
|
|
wm831x->num_gpio = 16;
|
|
wm831x->charger_irq_wake = 1;
|
|
if (rev > 0) {
|
|
wm831x->has_gpio_ena = 1;
|
|
wm831x->has_cs_sts = 1;
|
|
}
|
|
|
|
dev_info(wm831x->dev, "WM8310 revision %c\n", 'A' + rev);
|
|
break;
|
|
|
|
case WM8311:
|
|
parent = WM8311;
|
|
wm831x->num_gpio = 16;
|
|
wm831x->charger_irq_wake = 1;
|
|
if (rev > 0) {
|
|
wm831x->has_gpio_ena = 1;
|
|
wm831x->has_cs_sts = 1;
|
|
}
|
|
|
|
dev_info(wm831x->dev, "WM8311 revision %c\n", 'A' + rev);
|
|
break;
|
|
|
|
case WM8312:
|
|
parent = WM8312;
|
|
wm831x->num_gpio = 16;
|
|
wm831x->charger_irq_wake = 1;
|
|
if (rev > 0) {
|
|
wm831x->has_gpio_ena = 1;
|
|
wm831x->has_cs_sts = 1;
|
|
}
|
|
|
|
dev_info(wm831x->dev, "WM8312 revision %c\n", 'A' + rev);
|
|
break;
|
|
|
|
case WM8320:
|
|
parent = WM8320;
|
|
wm831x->num_gpio = 12;
|
|
dev_info(wm831x->dev, "WM8320 revision %c\n", 'A' + rev);
|
|
break;
|
|
|
|
case WM8321:
|
|
parent = WM8321;
|
|
wm831x->num_gpio = 12;
|
|
dev_info(wm831x->dev, "WM8321 revision %c\n", 'A' + rev);
|
|
break;
|
|
|
|
case WM8325:
|
|
parent = WM8325;
|
|
wm831x->num_gpio = 12;
|
|
dev_info(wm831x->dev, "WM8325 revision %c\n", 'A' + rev);
|
|
break;
|
|
|
|
case WM8326:
|
|
parent = WM8326;
|
|
wm831x->num_gpio = 12;
|
|
dev_info(wm831x->dev, "WM8326 revision %c\n", 'A' + rev);
|
|
break;
|
|
|
|
default:
|
|
dev_err(wm831x->dev, "Unknown WM831x device %04x\n", ret);
|
|
ret = -EINVAL;
|
|
goto err;
|
|
}
|
|
|
|
/* This will need revisiting in future but is OK for all
|
|
* current parts.
|
|
*/
|
|
if (parent != id)
|
|
dev_warn(wm831x->dev, "Device was registered as a WM%lx\n",
|
|
id);
|
|
|
|
/* Bootstrap the user key */
|
|
ret = wm831x_reg_read(wm831x, WM831X_SECURITY_KEY);
|
|
if (ret < 0) {
|
|
dev_err(wm831x->dev, "Failed to read security key: %d\n", ret);
|
|
goto err;
|
|
}
|
|
if (ret != 0) {
|
|
dev_warn(wm831x->dev, "Security key had non-zero value %x\n",
|
|
ret);
|
|
wm831x_reg_write(wm831x, WM831X_SECURITY_KEY, 0);
|
|
}
|
|
wm831x->locked = 1;
|
|
|
|
if (pdata && pdata->pre_init) {
|
|
ret = pdata->pre_init(wm831x);
|
|
if (ret != 0) {
|
|
dev_err(wm831x->dev, "pre_init() failed: %d\n", ret);
|
|
goto err;
|
|
}
|
|
}
|
|
|
|
if (pdata) {
|
|
for (i = 0; i < ARRAY_SIZE(pdata->gpio_defaults); i++) {
|
|
if (!pdata->gpio_defaults[i])
|
|
continue;
|
|
|
|
wm831x_reg_write(wm831x,
|
|
WM831X_GPIO1_CONTROL + i,
|
|
pdata->gpio_defaults[i] & 0xffff);
|
|
}
|
|
}
|
|
|
|
/* Multiply by 10 as we have many subdevices of the same type */
|
|
if (pdata && pdata->wm831x_num)
|
|
wm831x_num = pdata->wm831x_num * 10;
|
|
else
|
|
wm831x_num = -1;
|
|
|
|
ret = wm831x_irq_init(wm831x, irq);
|
|
if (ret != 0)
|
|
goto err;
|
|
|
|
wm831x_auxadc_init(wm831x);
|
|
|
|
/* The core device is up, instantiate the subdevices. */
|
|
switch (parent) {
|
|
case WM8310:
|
|
ret = mfd_add_devices(wm831x->dev, wm831x_num,
|
|
wm8310_devs, ARRAY_SIZE(wm8310_devs),
|
|
NULL, 0, NULL);
|
|
break;
|
|
|
|
case WM8311:
|
|
ret = mfd_add_devices(wm831x->dev, wm831x_num,
|
|
wm8311_devs, ARRAY_SIZE(wm8311_devs),
|
|
NULL, 0, NULL);
|
|
if (!pdata || !pdata->disable_touch)
|
|
mfd_add_devices(wm831x->dev, wm831x_num,
|
|
touch_devs, ARRAY_SIZE(touch_devs),
|
|
NULL, 0, NULL);
|
|
break;
|
|
|
|
case WM8312:
|
|
ret = mfd_add_devices(wm831x->dev, wm831x_num,
|
|
wm8312_devs, ARRAY_SIZE(wm8312_devs),
|
|
NULL, 0, NULL);
|
|
if (!pdata || !pdata->disable_touch)
|
|
mfd_add_devices(wm831x->dev, wm831x_num,
|
|
touch_devs, ARRAY_SIZE(touch_devs),
|
|
NULL, 0, NULL);
|
|
break;
|
|
|
|
case WM8320:
|
|
case WM8321:
|
|
case WM8325:
|
|
case WM8326:
|
|
ret = mfd_add_devices(wm831x->dev, wm831x_num,
|
|
wm8320_devs, ARRAY_SIZE(wm8320_devs),
|
|
NULL, 0, NULL);
|
|
break;
|
|
|
|
default:
|
|
/* If this happens the bus probe function is buggy */
|
|
BUG();
|
|
}
|
|
|
|
if (ret != 0) {
|
|
dev_err(wm831x->dev, "Failed to add children\n");
|
|
goto err_irq;
|
|
}
|
|
|
|
/* The RTC can only be used if the 32.768kHz crystal is
|
|
* enabled; this can't be controlled by software at runtime.
|
|
*/
|
|
ret = wm831x_reg_read(wm831x, WM831X_CLOCK_CONTROL_2);
|
|
if (ret < 0) {
|
|
dev_err(wm831x->dev, "Failed to read clock status: %d\n", ret);
|
|
goto err_irq;
|
|
}
|
|
|
|
if (ret & WM831X_XTAL_ENA) {
|
|
ret = mfd_add_devices(wm831x->dev, wm831x_num,
|
|
rtc_devs, ARRAY_SIZE(rtc_devs),
|
|
NULL, 0, NULL);
|
|
if (ret != 0) {
|
|
dev_err(wm831x->dev, "Failed to add RTC: %d\n", ret);
|
|
goto err_irq;
|
|
}
|
|
} else {
|
|
dev_info(wm831x->dev, "32.768kHz clock disabled, no RTC\n");
|
|
}
|
|
|
|
if (pdata && pdata->backlight) {
|
|
/* Treat errors as non-critical */
|
|
ret = mfd_add_devices(wm831x->dev, wm831x_num, backlight_devs,
|
|
ARRAY_SIZE(backlight_devs), NULL,
|
|
0, NULL);
|
|
if (ret < 0)
|
|
dev_err(wm831x->dev, "Failed to add backlight: %d\n",
|
|
ret);
|
|
}
|
|
|
|
wm831x_otp_init(wm831x);
|
|
|
|
if (pdata && pdata->post_init) {
|
|
ret = pdata->post_init(wm831x);
|
|
if (ret != 0) {
|
|
dev_err(wm831x->dev, "post_init() failed: %d\n", ret);
|
|
goto err_irq;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
|
|
err_irq:
|
|
wm831x_irq_exit(wm831x);
|
|
err:
|
|
mfd_remove_devices(wm831x->dev);
|
|
return ret;
|
|
}
|
|
|
|
void wm831x_device_exit(struct wm831x *wm831x)
|
|
{
|
|
wm831x_otp_exit(wm831x);
|
|
mfd_remove_devices(wm831x->dev);
|
|
free_irq(wm831x_irq(wm831x, WM831X_IRQ_AUXADC_DATA), wm831x);
|
|
wm831x_irq_exit(wm831x);
|
|
}
|
|
|
|
int wm831x_device_suspend(struct wm831x *wm831x)
|
|
{
|
|
int reg, mask;
|
|
|
|
/* If the charger IRQs are a wake source then make sure we ack
|
|
* them even if they're not actively being used (eg, no power
|
|
* driver or no IRQ line wired up) then acknowledge the
|
|
* interrupts otherwise suspend won't last very long.
|
|
*/
|
|
if (wm831x->charger_irq_wake) {
|
|
reg = wm831x_reg_read(wm831x, WM831X_INTERRUPT_STATUS_2_MASK);
|
|
|
|
mask = WM831X_CHG_BATT_HOT_EINT |
|
|
WM831X_CHG_BATT_COLD_EINT |
|
|
WM831X_CHG_BATT_FAIL_EINT |
|
|
WM831X_CHG_OV_EINT | WM831X_CHG_END_EINT |
|
|
WM831X_CHG_TO_EINT | WM831X_CHG_MODE_EINT |
|
|
WM831X_CHG_START_EINT;
|
|
|
|
/* If any of the interrupts are masked read the statuses */
|
|
if (reg & mask)
|
|
reg = wm831x_reg_read(wm831x,
|
|
WM831X_INTERRUPT_STATUS_2);
|
|
|
|
if (reg & mask) {
|
|
dev_info(wm831x->dev,
|
|
"Acknowledging masked charger IRQs: %x\n",
|
|
reg & mask);
|
|
wm831x_reg_write(wm831x, WM831X_INTERRUPT_STATUS_2,
|
|
reg & mask);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
void wm831x_device_shutdown(struct wm831x *wm831x)
|
|
{
|
|
if (wm831x->soft_shutdown) {
|
|
dev_info(wm831x->dev, "Initiating shutdown...\n");
|
|
wm831x_set_bits(wm831x, WM831X_POWER_STATE, WM831X_CHIP_ON, 0);
|
|
}
|
|
}
|
|
EXPORT_SYMBOL_GPL(wm831x_device_shutdown);
|
|
|
|
MODULE_DESCRIPTION("Core support for the WM831X AudioPlus PMIC");
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_AUTHOR("Mark Brown");
|