static inline int at91mci_is_mci1rev2xx(void) { return ( cpu_is_at91sam9260() || cpu_is_at91sam9263() || cpu_is_at91sam9rl() || cpu_is_at91sam9g10() || cpu_is_at91sam9g20() ); }
static int __devinit atmel_tsadcc_probe(struct platform_device *pdev) { struct atmel_tsadcc *ts_dev; struct input_dev *input_dev; struct resource *res; struct at91_tsadcc_data *pdata = pdev->dev.platform_data; int err = 0; unsigned int prsc; unsigned int reg; res = platform_get_resource(pdev, IORESOURCE_MEM, 0); if (!res) { dev_err(&pdev->dev, "no mmio resource defined.\n"); return -ENXIO; } /* Allocate memory for device */ ts_dev = kzalloc(sizeof(struct atmel_tsadcc), GFP_KERNEL); if (!ts_dev) { dev_err(&pdev->dev, "failed to allocate memory.\n"); return -ENOMEM; } platform_set_drvdata(pdev, ts_dev); input_dev = input_allocate_device(); if (!input_dev) { dev_err(&pdev->dev, "failed to allocate input device.\n"); err = -EBUSY; goto err_free_mem; } ts_dev->irq = platform_get_irq(pdev, 0); if (ts_dev->irq < 0) { dev_err(&pdev->dev, "no irq ID is designated.\n"); err = -ENODEV; goto err_free_dev; } if (!request_mem_region(res->start, resource_size(res), "atmel tsadcc regs")) { dev_err(&pdev->dev, "resources is unavailable.\n"); err = -EBUSY; goto err_free_dev; } tsc_base = ioremap(res->start, resource_size(res)); if (!tsc_base) { dev_err(&pdev->dev, "failed to map registers.\n"); err = -ENOMEM; goto err_release_mem; } err = request_irq(ts_dev->irq, atmel_tsadcc_interrupt, IRQF_DISABLED, pdev->dev.driver->name, ts_dev); if (err) { dev_err(&pdev->dev, "failed to allocate irq.\n"); goto err_unmap_regs; } ts_dev->clk = clk_get(&pdev->dev, "tsc_clk"); if (IS_ERR(ts_dev->clk)) { dev_err(&pdev->dev, "failed to get ts_clk\n"); err = PTR_ERR(ts_dev->clk); goto err_free_irq; } ts_dev->input = input_dev; ts_dev->bufferedmeasure = 0; snprintf(ts_dev->phys, sizeof(ts_dev->phys), "%s/input0", dev_name(&pdev->dev)); input_dev->name = "atmel touch screen controller"; input_dev->phys = ts_dev->phys; input_dev->dev.parent = &pdev->dev; __set_bit(EV_ABS, input_dev->evbit); input_set_abs_params(input_dev, ABS_X, 0, 0x3FF, 0, 0); input_set_abs_params(input_dev, ABS_Y, 0, 0x3FF, 0, 0); input_set_capability(input_dev, EV_KEY, BTN_TOUCH); /* clk_enable() always returns 0, no need to check it */ clk_enable(ts_dev->clk); prsc = clk_get_rate(ts_dev->clk); dev_info(&pdev->dev, "Master clock is set at: %d Hz\n", prsc); if (!pdata) goto err_fail; if (!pdata->adc_clock) pdata->adc_clock = ADC_DEFAULT_CLOCK; prsc = (prsc / (2 * pdata->adc_clock)) - 1; /* saturate if this value is too high */ if (cpu_is_at91sam9rl()) { if (prsc > PRESCALER_VAL(ATMEL_TSADCC_PRESCAL)) prsc = PRESCALER_VAL(ATMEL_TSADCC_PRESCAL); } else { if (prsc > PRESCALER_VAL(ATMEL_TSADCC_EPRESCAL)) prsc = PRESCALER_VAL(ATMEL_TSADCC_EPRESCAL); } dev_info(&pdev->dev, "Prescaler is set at: %d\n", prsc); reg = ATMEL_TSADCC_TSAMOD_TS_ONLY_MODE | ((0x00 << 5) & ATMEL_TSADCC_SLEEP) | /* Normal Mode */ ((0x01 << 6) & ATMEL_TSADCC_PENDET) | /* Enable Pen Detect */ (prsc << 8) | ((0x26 << 16) & ATMEL_TSADCC_STARTUP) | ((pdata->pendet_debounce << 28) & ATMEL_TSADCC_PENDBC); atmel_tsadcc_write(ATMEL_TSADCC_CR, ATMEL_TSADCC_SWRST); atmel_tsadcc_write(ATMEL_TSADCC_MR, reg); atmel_tsadcc_write(ATMEL_TSADCC_TRGR, ATMEL_TSADCC_TRGMOD_NONE); atmel_tsadcc_write(ATMEL_TSADCC_TSR, (pdata->ts_sample_hold_time << 24) & ATMEL_TSADCC_TSSHTIM); atmel_tsadcc_read(ATMEL_TSADCC_SR); atmel_tsadcc_write(ATMEL_TSADCC_IER, ATMEL_TSADCC_PENCNT); /* All went ok, so register to the input system */ err = input_register_device(input_dev); if (err) goto err_fail; return 0; err_fail: clk_disable(ts_dev->clk); clk_put(ts_dev->clk); err_free_irq: free_irq(ts_dev->irq, ts_dev); err_unmap_regs: iounmap(tsc_base); err_release_mem: release_mem_region(res->start, resource_size(res)); err_free_dev: input_free_device(input_dev); err_free_mem: kfree(ts_dev); return err; }