static void tscadc_idle_config(struct ti_tscadc_dev *config)
{
unsigned int idleconfig;
idleconfig = STEPCONFIG_YNN | STEPCONFIG_INM_ADCREFM |
STEPCONFIG_INP_ADCREFM | STEPCONFIG_YPN;
tscadc_writel(config, REG_IDLECONFIG, idleconfig);
}
static int tscadc_suspend(struct device *dev)
{
struct ti_tscadc_dev *tscadc_dev = dev_get_drvdata(dev);
tscadc_writel(tscadc_dev, REG_SE, 0x00);
pm_runtime_put_sync(dev);
return 0;
}
static void tsc_idle_config(struct tscadc *ts_config)
{
/* Idle mode touch screen config */
unsigned int idleconfig;
idleconfig = TSCADC_STEPCONFIG_YNN | TSCADC_STEPCONFIG_INM |
TSCADC_STEPCONFIG_IDLE_INP | TSCADC_STEPCONFIG_YPN;
tscadc_writel(ts_config, TSCADC_REG_IDLECONFIG, idleconfig);
}
static int tscadc_resume(struct device *dev)
{
struct ti_tscadc_dev *tscadc_dev = dev_get_drvdata(dev);
unsigned int restore, ctrl;
pm_runtime_get_sync(dev);
/* context restore */
ctrl = CNTRLREG_STEPCONFIGWRT | CNTRLREG_TSCENB |
CNTRLREG_STEPID | CNTRLREG_4WIRE;
tscadc_writel(tscadc_dev, REG_CTRL, ctrl);
tscadc_idle_config(tscadc_dev);
tscadc_writel(tscadc_dev, REG_SE, STPENB_STEPENB);
restore = tscadc_readl(tscadc_dev, REG_CTRL);
tscadc_writel(tscadc_dev, REG_CTRL,
(restore | CNTRLREG_TSCSSENB));
return 0;
}
static int tscadc_resume(struct platform_device *pdev)
{
struct ti_tscadc_dev *tscadc_dev = platform_get_drvdata(pdev);
struct mfd_tscadc_board *pdata = pdev->dev.platform_data;
unsigned int irq_read;
pm_runtime_get_sync(&pdev->dev);
/* context restore */
irq_read = tscadc_readl(tscadc_dev, TSCADC_REG_IRQSTATUS);
tscadc_writel(tscadc_dev, TSCADC_REG_IRQSTATUS, irq_read);
tscadc_writel(tscadc_dev, TSCADC_REG_IRQENABLE, tscadc_dev->irqstat);
if (pdata->tsc_init)
tscadc_idle_config(tscadc_dev);
tscadc_writel(tscadc_dev, TSCADC_REG_SE, TSCADC_STPENB_STEPENB_TC);
tscadc_writel(tscadc_dev, TSCADC_REG_CTRL, tscadc_dev->ctrl);
return 0;
}
static int tscadc_suspend(struct platform_device *pdev, pm_message_t state)
{
struct ti_tscadc_dev *tscadc_dev = platform_get_drvdata(pdev);
tscadc_writel(tscadc_dev, TSCADC_REG_SE, 0x00);
tscadc_dev->irqstat = tscadc_readl(tscadc_dev, TSCADC_REG_IRQENABLE);
tscadc_dev->ctrl = tscadc_readl(tscadc_dev, TSCADC_REG_CTRL);
pm_runtime_put_sync(&pdev->dev);
return 0;
}
static int __devexit ti_tscadc_remove(struct platform_device *pdev)
{
struct ti_tscadc_dev *tscadc = platform_get_drvdata(pdev);
tscadc_writel(tscadc, REG_SE, 0x00);
pm_runtime_put_sync(&pdev->dev);
pm_runtime_disable(&pdev->dev);
mfd_remove_devices(tscadc->dev);
return 0;
}
static void tsc_idle_config(struct tscadc *ts_config)
{
/* Idle mode touch screen config */
unsigned int idleconfig;
idleconfig = TSCADC_STEPCONFIG_YNN |
TSCADC_STEPCONFIG_INM | TSCADC_STEPCONFIG_IDLE_INP;
if (ts_config->analog_input == 0)
idleconfig |= TSCADC_STEPCONFIG_XNN;
else
idleconfig |= TSCADC_STEPCONFIG_YPN;
tscadc_writel(ts_config, TSCADC_REG_IDLECONFIG, idleconfig);
}
static int __devexit ti_tscadc_remove(struct platform_device *pdev)
{
struct ti_tscadc_dev *tscadc = platform_get_drvdata(pdev);
struct resource *res;
tscadc_writel(tscadc, TSCADC_REG_SE, 0x00);
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
iounmap(tscadc->tscadc_base);
release_mem_region(res->start, resource_size(res));
pm_runtime_put_sync(&pdev->dev);
pm_runtime_disable(&pdev->dev);
mfd_remove_devices(tscadc->dev);
kfree(tscadc);
platform_set_drvdata(pdev, NULL);
return 0;
}
static void tsc_step_config(struct tscadc *ts_dev)
{
unsigned int stepconfigx = 0, stepconfigy = 0;
unsigned int delay, chargeconfig = 0;
unsigned int stepconfigz1 = 0, stepconfigz2 = 0;
int i;
/* Configure the Step registers */
delay = TSCADC_STEPCONFIG_SAMPLEDLY | TSCADC_STEPCONFIG_OPENDLY;
stepconfigx = TSCADC_STEPCONFIG_MODE_HWSYNC |
TSCADC_STEPCONFIG_2SAMPLES_AVG | TSCADC_STEPCONFIG_XPP;
switch (ts_dev->wires) {
case 4:
stepconfigx |= TSCADC_STEPCONFIG_INP |
TSCADC_STEPCONFIG_XNN;
break;
case 5:
stepconfigx |= TSCADC_STEPCONFIG_YNN |
TSCADC_STEPCONFIG_INP_5 | TSCADC_STEPCONFIG_XNN |
TSCADC_STEPCONFIG_YPP;
break;
case 8:
stepconfigx |= TSCADC_STEPCONFIG_INP |
TSCADC_STEPCONFIG_XNN;
break;
}
for (i = 1; i < 7; i++) {
tscadc_writel(ts_dev, TSCADC_REG_STEPCONFIG(i), stepconfigx);
tscadc_writel(ts_dev, TSCADC_REG_STEPDELAY(i), delay);
}
stepconfigy = TSCADC_STEPCONFIG_MODE_HWSYNC |
TSCADC_STEPCONFIG_2SAMPLES_AVG | TSCADC_STEPCONFIG_YNN |
TSCADC_STEPCONFIG_INM | TSCADC_STEPCONFIG_FIFO1;
switch (ts_dev->wires) {
case 4:
stepconfigy |= TSCADC_STEPCONFIG_YPP;
break;
case 5:
stepconfigy |= TSCADC_STEPCONFIG_XPP | TSCADC_STEPCONFIG_INP_5 |
TSCADC_STEPCONFIG_XNP | TSCADC_STEPCONFIG_YPN;
break;
case 8:
stepconfigy |= TSCADC_STEPCONFIG_YPP;
break;
}
for (i = 7; i < 13; i++) {
tscadc_writel(ts_dev, TSCADC_REG_STEPCONFIG(i), stepconfigy);
tscadc_writel(ts_dev, TSCADC_REG_STEPDELAY(i), delay);
}
chargeconfig = TSCADC_STEPCONFIG_XPP | TSCADC_STEPCONFIG_YNN |
TSCADC_STEPCONFIG_RFP | TSCADC_STEPCHARGE_RFM |
TSCADC_STEPCHARGE_INM | TSCADC_STEPCHARGE_INP;
tscadc_writel(ts_dev, TSCADC_REG_CHARGECONFIG, chargeconfig);
tscadc_writel(ts_dev, TSCADC_REG_CHARGEDELAY, TSCADC_STEPCHARGE_DELAY);
/* Configure to calculate pressure */
stepconfigz1 = TSCADC_STEPCONFIG_MODE_HWSYNC |
TSCADC_STEPCONFIG_2SAMPLES_AVG |
TSCADC_STEPCONFIG_XNP |
TSCADC_STEPCONFIG_YPN | TSCADC_STEPCONFIG_INM;
stepconfigz2 = stepconfigz1 | TSCADC_STEPCONFIG_Z1 |
TSCADC_STEPCONFIG_FIFO1;
tscadc_writel(ts_dev, TSCADC_REG_STEPCONFIG13, stepconfigz1);
tscadc_writel(ts_dev, TSCADC_REG_STEPDELAY13, delay);
tscadc_writel(ts_dev, TSCADC_REG_STEPCONFIG14, stepconfigz2);
tscadc_writel(ts_dev, TSCADC_REG_STEPDELAY14, delay);
tscadc_writel(ts_dev, TSCADC_REG_SE, TSCADC_STPENB_STEPENB);
}
static int __devinit ti_tscadc_probe(struct platform_device *pdev)
{
struct ti_tscadc_dev *tscadc;
struct resource *res;
struct clk *clk;
struct mfd_tscadc_board *pdata = pdev->dev.platform_data;
struct mfd_cell *cell;
int irq;
int err, ctrl;
int clk_value, clock_rate;
int tsc_wires = 0, adc_channels = 0, total_channels;
if (!pdata) {
dev_err(&pdev->dev, "Could not find platform data\n");
return -EINVAL;
}
if (pdata->adc_init)
adc_channels = pdata->adc_init->adc_channels;
if (pdata->tsc_init)
tsc_wires = pdata->tsc_init->wires;
total_channels = tsc_wires + adc_channels;
if (total_channels > 8) {
dev_err(&pdev->dev, "Number of i/p channels more than 8\n");
return -EINVAL;
}
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
if (!res) {
dev_err(&pdev->dev, "no memory resource defined.\n");
return -EINVAL;
}
irq = platform_get_irq(pdev, 0);
if (irq < 0) {
dev_err(&pdev->dev, "no irq ID is specified.\n");
return -EINVAL;
}
/* Allocate memory for device */
tscadc = devm_kzalloc(&pdev->dev,
sizeof(struct ti_tscadc_dev), GFP_KERNEL);
if (!tscadc) {
dev_err(&pdev->dev, "failed to allocate memory.\n");
return -ENOMEM;
}
tscadc->dev = &pdev->dev;
tscadc->irq = irq;
res = devm_request_mem_region(&pdev->dev,
res->start, resource_size(res), pdev->name);
if (!res) {
dev_err(&pdev->dev, "failed to reserve registers.\n");
err = -EBUSY;
goto err;
}
tscadc->tscadc_base = devm_ioremap(&pdev->dev,
res->start, resource_size(res));
if (!tscadc->tscadc_base) {
dev_err(&pdev->dev, "failed to map registers.\n");
err = -ENOMEM;
goto err;
}
tscadc->regmap_tscadc = devm_regmap_init_mmio(&pdev->dev,
tscadc->tscadc_base, &tscadc_regmap_config);
if (IS_ERR(tscadc->regmap_tscadc)) {
dev_err(&pdev->dev, "regmap init failed\n");
err = PTR_ERR(tscadc->regmap_tscadc);
goto err;
}
pm_runtime_enable(&pdev->dev);
pm_runtime_get_sync(&pdev->dev);
/*
* The TSC_ADC_Subsystem has 2 clock domains
* OCP_CLK and ADC_CLK.
* The ADC clock is expected to run at target of 3MHz,
* and expected to capture 12-bit data at a rate of 200 KSPS.
* The TSC_ADC_SS controller design assumes the OCP clock is
* at least 6x faster than the ADC clock.
*/
clk = clk_get(&pdev->dev, "adc_tsc_fck");
if (IS_ERR(clk)) {
dev_err(&pdev->dev, "failed to get TSC fck\n");
err = PTR_ERR(clk);
goto err_disable_clk;
}
clock_rate = clk_get_rate(clk);
clk_put(clk);
clk_value = clock_rate / ADC_CLK;
if (clk_value < MAX_CLK_DIV) {
dev_err(&pdev->dev, "clock input less than min clock requirement\n");
err = -EINVAL;
goto err_disable_clk;
}
/* TSCADC_CLKDIV needs to be configured to the value minus 1 */
clk_value = clk_value - 1;
tscadc_writel(tscadc, REG_CLKDIV, clk_value);
/* Set the control register bits */
ctrl = CNTRLREG_STEPCONFIGWRT |
CNTRLREG_TSCENB |
CNTRLREG_STEPID |
CNTRLREG_4WIRE;
tscadc_writel(tscadc, REG_CTRL, ctrl);
/* Set register bits for Idle Config Mode */
tscadc_idle_config(tscadc);
/* Enable the TSC module enable bit */
ctrl = tscadc_readl(tscadc, REG_CTRL);
ctrl |= CNTRLREG_TSCSSENB;
tscadc_writel(tscadc, REG_CTRL, ctrl);
tscadc->used_cells = 0;
tscadc->tsc_cell = -1;
tscadc->adc_cell = -1;
/* TSC Cell */
if (tsc_wires > 0) {
tscadc->tsc_cell = tscadc->used_cells;
cell = &tscadc->cells[tscadc->used_cells++];
cell->name = "tsc";
cell->platform_data = tscadc;
cell->pdata_size = sizeof(*tscadc);
}
/* ADC Cell */
if (adc_channels > 0) {
tscadc->adc_cell = tscadc->used_cells;
cell = &tscadc->cells[tscadc->used_cells++];
cell->name = "tiadc";
cell->platform_data = tscadc;
cell->pdata_size = sizeof(*tscadc);
}
err = mfd_add_devices(&pdev->dev, pdev->id, tscadc->cells,
tscadc->used_cells, NULL, 0, NULL);
if (err < 0)
goto err_disable_clk;
device_init_wakeup(&pdev->dev, true);
platform_set_drvdata(pdev, tscadc);
dev_info(&pdev->dev, "Initialized OK.\n");
return 0;
err_disable_clk:
pm_runtime_put_sync(&pdev->dev);
pm_runtime_disable(&pdev->dev);
err:
return err;
}