/* arch/arm/plat-samsung/adc.c * * Copyright (c) 2008 Simtec Electronics * http://armlinux.simtec.co.uk/ * Ben Dooks , * * Samsung ADC device core * * 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. */ #include #include #include #include #include #include #include #include #include #include #include #include /* This driver is designed to control the usage of the ADC block between * the touchscreen and any other drivers that may need to use it, such as * the hwmon driver. * * Priority will be given to the touchscreen driver, but as this itself is * rate limited it should not starve other requests which are processed in * order that they are received. * * Each user registers to get a client block which uniquely identifies it * and stores information such as the necessary functions to callback when * action is required. */ enum s3c_cpu_type { TYPE_ADCV1, /* S3C24XX */ TYPE_ADCV2, /* S3C64XX, S5P64X0, S5PC100 */ TYPE_ADCV3, /* S5PV210, S5PC110, EXYNOS4210 */ TYPE_ADCV4, /* EXYNOS4412, EXYNOS5250 */ }; struct s3c_adc_client { struct platform_device *pdev; struct list_head pend; wait_queue_head_t *wait; unsigned int nr_samples; int result; unsigned char is_ts; unsigned char channel; void (*select_cb)(struct s3c_adc_client *c, unsigned selected); void (*convert_cb)(struct s3c_adc_client *c, unsigned val1, unsigned val2, unsigned *samples_left); atomic_t running; int error_count; }; struct adc_device { struct platform_device *pdev; struct platform_device *owner; struct clk *clk; struct s3c_adc_client *cur; struct s3c_adc_client *ts_pend; void __iomem *regs; spinlock_t lock; unsigned int prescale; int irq; }; static struct adc_device *adc_dev; static LIST_HEAD(adc_pending); /* protected by adc_device.lock */ #define adc_dbg(_adc, msg...) dev_dbg(&(_adc)->pdev->dev, msg) static inline void s3c_adc_convert(struct adc_device *adc) { unsigned con = readl(adc->regs + S3C2410_ADCCON); con |= S3C2410_ADCCON_ENABLE_START; writel(con, adc->regs + S3C2410_ADCCON); } static inline void s3c_adc_select(struct adc_device *adc, struct s3c_adc_client *client) { unsigned con = readl(adc->regs + S3C2410_ADCCON); enum s3c_cpu_type cpu = platform_get_device_id(adc->pdev)->driver_data; client->select_cb(client, 1); con &= ~S3C2410_ADCCON_MUXMASK; con &= ~S3C2410_ADCCON_STDBM; con &= ~S3C2410_ADCCON_STARTMASK; con |= S3C2410_ADCCON_PRSCEN; if (!client->is_ts) { if (cpu >= TYPE_ADCV3) writel(S5PV210_ADCCON_SELMUX(client->channel), adc->regs + S5P_ADCMUX); else con |= S3C2410_ADCCON_SELMUX(client->channel); } writel(con, adc->regs + S3C2410_ADCCON); } static void s3c_adc_dbgshow(struct adc_device *adc) { adc_dbg(adc, "CON=%08x, DLY=%08x\n", readl(adc->regs + S3C2410_ADCCON), readl(adc->regs + S3C2410_ADCDLY)); } static void s3c_adc_try(struct adc_device *adc) { struct s3c_adc_client *next = adc->ts_pend; unsigned int con = readl(adc->regs + S3C2410_ADCCON); if (!next && !list_empty(&adc_pending)) { next = list_first_entry(&adc_pending, struct s3c_adc_client, pend); list_del(&next->pend); } else adc->ts_pend = NULL; if (next) { adc_dbg(adc, "new client is %p\n", next); adc->cur = next; s3c_adc_select(adc, next); s3c_adc_convert(adc); s3c_adc_dbgshow(adc); } else { con &= ~S3C2410_ADCCON_PRSCEN; con |= S3C2410_ADCCON_STDBM; writel(con, adc->regs + S3C2410_ADCCON); } } static void s3c_convert_done(struct s3c_adc_client *client, unsigned v, unsigned u, unsigned *left) { client->result = v; wake_up(client->wait); } int s3c_adc_start(struct s3c_adc_client *client, unsigned int channel, unsigned int nr_samples, wait_queue_head_t *pwake) { struct adc_device *adc = adc_dev; unsigned long flags; BUG_ON(!adc); if (client->is_ts && adc->ts_pend) return -EAGAIN; if (atomic_xchg(&client->running, 1)) { WARN(1, "%s: %p is already running\n", __func__, client); return -EAGAIN; } spin_lock_irqsave(&adc->lock, flags); if (client->is_ts && adc->ts_pend) { spin_unlock_irqrestore(&adc->lock, flags); return -EAGAIN; } client->convert_cb = s3c_convert_done; client->wait = pwake; client->result = -1; client->channel = channel; client->nr_samples = nr_samples; if (client->is_ts) adc->ts_pend = client; else list_add_tail(&client->pend, &adc_pending); if (!adc->cur) s3c_adc_try(adc); spin_unlock_irqrestore(&adc->lock, flags); return 0; } EXPORT_SYMBOL_GPL(s3c_adc_start); static void s3c_adc_stop(struct s3c_adc_client *client) { unsigned long flags; spin_lock_irqsave(&adc_dev->lock, flags); /* We should really check that nothing is in progress. */ if (adc_dev->cur == client) adc_dev->cur = NULL; if (adc_dev->ts_pend == client) adc_dev->ts_pend = NULL; else { struct list_head *p, *n; struct s3c_adc_client *tmp; list_for_each_safe(p, n, &adc_pending) { tmp = list_entry(p, struct s3c_adc_client, pend); if (tmp == client) list_del(&tmp->pend); } } if (!atomic_xchg(&client->running, 0)) WARN(1, "%s: %p is already stopped\n", __func__, client); if (adc_dev->cur == NULL) s3c_adc_try(adc_dev); spin_unlock_irqrestore(&adc_dev->lock, flags); } int s3c_adc_read(struct s3c_adc_client *client, unsigned int ch) { DECLARE_WAIT_QUEUE_HEAD_ONSTACK(wake); struct adc_device *adc = adc_dev; unsigned long flags; int ret; ret = s3c_adc_start(client, ch, 1, &wake); if (ret < 0) goto err; ret = wait_event_timeout(wake, client->result >= 0, HZ / 2); if (client->result < 0) { s3c_adc_stop(client); dev_warn(&adc_dev->pdev->dev, "%s: %p is timed out\n", __func__, client); ++client->error_count; BUG_ON(client->error_count > 10); ret = -ETIMEDOUT; goto err; } else { client->error_count = 0; spin_lock_irqsave(&adc->lock, flags); /* client->result >=0 means s3c_adc_irq -> s3c_convert_done is running or finished. Make sure it is *finished* (not running) by lock/unlocking spin lock. Otherwise, after return of this function, wake_up() on destroyed 'wake' may be executed which will destroy stack */ spin_unlock_irqrestore(&adc->lock, flags); } client->convert_cb = NULL; return client->result; err: return ret; } EXPORT_SYMBOL_GPL(s3c_adc_read); static void s3c_adc_default_select(struct s3c_adc_client *client, unsigned select) { } struct s3c_adc_client *s3c_adc_register(struct platform_device *pdev, void (*select)(struct s3c_adc_client *client, unsigned int selected), void (*conv)(struct s3c_adc_client *client, unsigned d0, unsigned d1, unsigned *samples_left), unsigned int is_ts) { struct s3c_adc_client *client; WARN_ON(!pdev); if (!select) select = s3c_adc_default_select; if (!pdev) return ERR_PTR(-EINVAL); client = kzalloc(sizeof(struct s3c_adc_client), GFP_KERNEL); if (!client) { dev_err(&pdev->dev, "no memory for adc client\n"); return ERR_PTR(-ENOMEM); } client->pdev = pdev; client->is_ts = is_ts; client->select_cb = select; client->convert_cb = conv; return client; } EXPORT_SYMBOL_GPL(s3c_adc_register); void s3c_adc_release(struct s3c_adc_client *client) { s3c_adc_stop(client); kfree(client); } EXPORT_SYMBOL_GPL(s3c_adc_release); static irqreturn_t s3c_adc_irq(int irq, void *pw) { struct adc_device *adc = pw; struct s3c_adc_client *client = adc->cur; enum s3c_cpu_type cpu = platform_get_device_id(adc->pdev)->driver_data; unsigned data0 = 0, data1 = 0; spin_lock(&adc->lock); if (!client || !client->nr_samples) { dev_warn(&adc->pdev->dev, "%s: no adc pending\n", __func__); goto exit; } data0 = readl(adc->regs + S3C2410_ADCDAT0); if (cpu != TYPE_ADCV4) data1 = readl(adc->regs + S3C2410_ADCDAT1); adc_dbg(adc, "read %d: 0x%04x, 0x%04x\n", client->nr_samples, data0, data1); if (client->nr_samples > 0) client->nr_samples--; if (cpu == TYPE_ADCV1) { data0 &= 0x3ff; data1 &= 0x3ff; } else { /* S3C64XX/S5P ADC resolution is 12-bit */ data0 &= 0xfff; data1 &= 0xfff; } if (client->convert_cb) (client->convert_cb)(client, data0, data1, &client->nr_samples); if (client->nr_samples > 0) { /* fire another conversion for this client */ (client->select_cb)(client, 1); s3c_adc_convert(adc); } else { /* finish conversion for this client */ (client->select_cb)(client, 0); if (!atomic_xchg(&client->running, 0)) WARN(1, "%s: %p is already stopped\n", __func__, client); /* fire conversion for next client if any */ adc->cur = NULL; s3c_adc_try(adc); } exit: if (cpu != TYPE_ADCV1) { /* Clear ADC interrupt */ writel(0, adc->regs + S3C64XX_ADCCLRINT); } spin_unlock(&adc->lock); return IRQ_HANDLED; } static int s3c_adc_probe(struct platform_device *pdev) { struct device *dev = &pdev->dev; struct adc_device *adc; struct resource *regs; enum s3c_cpu_type cpu = platform_get_device_id(pdev)->driver_data; int ret; unsigned tmp; adc = kzalloc(sizeof(struct adc_device), GFP_KERNEL); if (unlikely(adc == NULL)) { dev_err(dev, "failed to allocate adc_device\n"); return -ENOMEM; } spin_lock_init(&adc->lock); adc->pdev = pdev; adc->prescale = S3C2410_ADCCON_PRSCVL(49); adc->clk = clk_get(NULL, "adc"); if (unlikely(IS_ERR(adc->clk))) { dev_err(dev, "failed to get adc clock\n"); ret = PTR_ERR(adc->clk); goto err_alloc; } regs = platform_get_resource(pdev, IORESOURCE_MEM, 0); if (unlikely(!regs)) { dev_err(dev, "failed to find registers\n"); ret = -ENXIO; goto err_clk; } adc->regs = ioremap(regs->start, resource_size(regs)); if (unlikely(!adc->regs)) { dev_err(dev, "failed to map registers\n"); ret = -ENXIO; goto err_clk; } clk_enable(adc->clk); #if defined(CONFIG_S3C_DEV_ADC1) tmp = readl(adc->regs + S3C2410_ADCCON); tmp |= S3C64XX_ADCCON_TSSEL; writel(tmp, adc->regs + S3C2410_ADCCON); adc->regs += 0x1000; #endif tmp = adc->prescale | S3C2410_ADCCON_PRSCEN; /* Enable 12-bit ADC resolution */ if (cpu != TYPE_ADCV1) { tmp |= S3C64XX_ADCCON_RESSEL; } tmp |= S3C2410_ADCCON_STDBM; writel(tmp, adc->regs + S3C2410_ADCCON); adc->irq = platform_get_irq(pdev, 1); if (unlikely(adc->irq <= 0)) { dev_err(dev, "failed to get adc irq\n"); ret = -ENOENT; goto err_clk; } ret = request_irq(adc->irq, s3c_adc_irq, 0, dev_name(dev), adc); if (unlikely(ret < 0)) { dev_err(dev, "failed to attach adc irq\n"); goto err_clk; } dev_info(dev, "attached adc driver\n"); platform_set_drvdata(pdev, adc); adc_dev = adc; return 0; err_clk: clk_put(adc->clk); err_alloc: kfree(adc); return ret; } static int __devexit s3c_adc_remove(struct platform_device *pdev) { struct adc_device *adc = platform_get_drvdata(pdev); iounmap(adc->regs); free_irq(adc->irq, adc); clk_disable(adc->clk); clk_put(adc->clk); kfree(adc); return 0; } #ifdef CONFIG_PM static int s3c_adc_suspend(struct platform_device *pdev, pm_message_t state) { struct adc_device *adc = platform_get_drvdata(pdev); unsigned long flags; u32 con; spin_lock_irqsave(&adc->lock, flags); con = readl(adc->regs + S3C2410_ADCCON); con |= S3C2410_ADCCON_STDBM; writel(con, adc->regs + S3C2410_ADCCON); disable_irq(adc->irq); spin_unlock_irqrestore(&adc->lock, flags); clk_disable(adc->clk); return 0; } static int s3c_adc_resume(struct platform_device *pdev) { struct adc_device *adc = platform_get_drvdata(pdev); enum s3c_cpu_type cpu = platform_get_device_id(pdev)->driver_data; unsigned int tmp = 0; clk_enable(adc->clk); enable_irq(adc->irq); #if defined(CONFIG_S3C_DEV_ADC1) adc->regs -= 0x1000; tmp = readl(adc->regs + S3C2410_ADCCON); tmp |= S3C64XX_ADCCON_TSSEL; writel(tmp, adc->regs + S3C2410_ADCCON); adc->regs += 0x1000; #endif tmp = adc->prescale | S3C2410_ADCCON_PRSCEN; /* Enable 12-bit ADC resolution */ if (cpu != TYPE_ADCV1) tmp |= S3C64XX_ADCCON_RESSEL; writel(tmp, adc->regs + S3C2410_ADCCON); return 0; } #else #define s3c_adc_suspend NULL #define s3c_adc_resume NULL #endif static struct platform_device_id s3c_adc_driver_ids[] = { { .name = "s3c24xx-adc", .driver_data = TYPE_ADCV1, }, { .name = "s3c64xx-adc", .driver_data = TYPE_ADCV2, }, { .name = "samsung-adc-v3", .driver_data = TYPE_ADCV3, }, { .name = "samsung-adc-v4", .driver_data = TYPE_ADCV4, }, { } }; MODULE_DEVICE_TABLE(platform, s3c_adc_driver_ids); static struct platform_driver s3c_adc_driver = { .id_table = s3c_adc_driver_ids, .driver = { .name = "s3c-adc", .owner = THIS_MODULE, }, .probe = s3c_adc_probe, .remove = __devexit_p(s3c_adc_remove), .suspend = s3c_adc_suspend, .resume = s3c_adc_resume, }; static int __init adc_init(void) { int ret; ret = platform_driver_register(&s3c_adc_driver); if (ret) printk(KERN_ERR "%s: failed to add adc driver\n", __func__); return ret; } arch_initcall(adc_init);