| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| #include <linux/module.h> |
| #include <linux/moduleparam.h> |
| #include <linux/kernel.h> |
| #include <linux/input.h> |
| #include <linux/delay.h> |
| #include <linux/bitops.h> |
| #include <linux/wm97xx.h> |
| |
| #define TS_NAME "wm97xx" |
| #define WM9705_VERSION "1.00" |
| #define DEFAULT_PRESSURE 0xb0c0 |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| static int pil; |
| module_param(pil, int, 0); |
| MODULE_PARM_DESC(pil, "Set current used for pressure measurement."); |
| |
| |
| |
| |
| |
| |
| static int pressure = DEFAULT_PRESSURE & 0xfff; |
| module_param(pressure, int, 0); |
| MODULE_PARM_DESC(pressure, "Set threshold for pressure measurement."); |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| static int delay = 4; |
| module_param(delay, int, 0); |
| MODULE_PARM_DESC(delay, "Set adc sample delay."); |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| static int pdd = 8; |
| module_param(pdd, int, 0); |
| MODULE_PARM_DESC(pdd, "Set pen detect comparator threshold"); |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| |
| static int mask; |
| module_param(mask, int, 0); |
| MODULE_PARM_DESC(mask, "Set adc mask function."); |
| |
| |
| |
| |
| static const int delay_table[] = { |
| <------>21, |
| <------>42, |
| <------>84, |
| <------>167, |
| <------>333, |
| <------>667, |
| <------>1000, |
| <------>1333, |
| <------>2000, |
| <------>2667, |
| <------>3333, |
| <------>4000, |
| <------>4667, |
| <------>5333, |
| <------>6000, |
| <------>0 |
| }; |
| |
| |
| |
| |
| |
| |
| static inline void poll_delay(int d) |
| { |
| <------>udelay(3 * AC97_LINK_FRAME + delay_table[d]); |
| } |
| |
| |
| |
| |
| static void wm9705_phy_init(struct wm97xx *wm) |
| { |
| <------>u16 dig1 = 0, dig2 = WM97XX_RPR; |
| |
| <------> |
| <------>* mute VIDEO and AUX as they share X and Y touchscreen |
| <------>* inputs on the WM9705 |
| <------>*/ |
| <------>wm97xx_reg_write(wm, AC97_AUX, 0x8000); |
| <------>wm97xx_reg_write(wm, AC97_VIDEO, 0x8000); |
| |
| <------> |
| <------>if (pil == 2) { |
| <------><------>dig2 |= WM9705_PIL; |
| <------><------>dev_dbg(wm->dev, |
| <------><------><------>"setting pressure measurement current to 400uA."); |
| <------>} else if (pil) |
| <------><------>dev_dbg(wm->dev, |
| <------><------><------>"setting pressure measurement current to 200uA."); |
| <------>if (!pil) |
| <------><------>pressure = 0; |
| |
| <------> |
| <------>if (delay != 4) { |
| <------><------>if (delay < 0 || delay > 15) { |
| <------><------><------>dev_dbg(wm->dev, "supplied delay out of range."); |
| <------><------><------>delay = 4; |
| <------><------>} |
| <------>} |
| <------>dig1 &= 0xff0f; |
| <------>dig1 |= WM97XX_DELAY(delay); |
| <------>dev_dbg(wm->dev, "setting adc sample delay to %d u Secs.", |
| <------><------>delay_table[delay]); |
| |
| <------> |
| <------>dig2 |= (pdd & 0x000f); |
| <------>dev_dbg(wm->dev, "setting pdd to Vmid/%d", 1 - (pdd & 0x000f)); |
| |
| <------> |
| <------>dig2 |= ((mask & 0x3) << 4); |
| |
| <------>wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER1, dig1); |
| <------>wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER2, dig2); |
| } |
| |
| static void wm9705_dig_enable(struct wm97xx *wm, int enable) |
| { |
| <------>if (enable) { |
| <------><------>wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER2, |
| <------><------><------><------> wm->dig[2] | WM97XX_PRP_DET_DIG); |
| <------><------>wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD); |
| <------>} else |
| <------><------>wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER2, |
| <------><------><------><------> wm->dig[2] & ~WM97XX_PRP_DET_DIG); |
| } |
| |
| static void wm9705_aux_prepare(struct wm97xx *wm) |
| { |
| <------>memcpy(wm->dig_save, wm->dig, sizeof(wm->dig)); |
| <------>wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER1, 0); |
| <------>wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER2, WM97XX_PRP_DET_DIG); |
| } |
| |
| static void wm9705_dig_restore(struct wm97xx *wm) |
| { |
| <------>wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER1, wm->dig_save[1]); |
| <------>wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER2, wm->dig_save[2]); |
| } |
| |
| static inline int is_pden(struct wm97xx *wm) |
| { |
| <------>return wm->dig[2] & WM9705_PDEN; |
| } |
| |
| |
| |
| |
| static int wm9705_poll_sample(struct wm97xx *wm, int adcsel, int *sample) |
| { |
| <------>int timeout = 5 * delay; |
| <------>bool wants_pen = adcsel & WM97XX_PEN_DOWN; |
| |
| <------>if (wants_pen && !wm->pen_probably_down) { |
| <------><------>u16 data = wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD); |
| <------><------>if (!(data & WM97XX_PEN_DOWN)) |
| <------><------><------>return RC_PENUP; |
| <------><------>wm->pen_probably_down = 1; |
| <------>} |
| |
| <------> |
| <------>if (wm->mach_ops && wm->mach_ops->pre_sample) |
| <------><------>wm->mach_ops->pre_sample(adcsel); |
| <------>wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER1, (adcsel & WM97XX_ADCSEL_MASK) |
| <------><------><------><------>| WM97XX_POLL | WM97XX_DELAY(delay)); |
| |
| <------> |
| <------>poll_delay(delay); |
| |
| <------> |
| <------>while ((wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER1) & WM97XX_POLL) |
| <------> && timeout) { |
| <------><------>udelay(AC97_LINK_FRAME); |
| <------><------>timeout--; |
| <------>} |
| |
| <------>if (timeout == 0) { |
| <------><------> |
| <------><------>if (is_pden(wm)) |
| <------><------><------>wm->pen_probably_down = 0; |
| <------><------>else |
| <------><------><------>dev_dbg(wm->dev, "adc sample timeout"); |
| <------><------>return RC_PENUP; |
| <------>} |
| |
| <------>*sample = wm97xx_reg_read(wm, AC97_WM97XX_DIGITISER_RD); |
| <------>if (wm->mach_ops && wm->mach_ops->post_sample) |
| <------><------>wm->mach_ops->post_sample(adcsel); |
| |
| <------> |
| <------>if ((*sample ^ adcsel) & WM97XX_ADCSEL_MASK) { |
| <------><------>dev_dbg(wm->dev, "adc wrong sample, wanted %x got %x", |
| <------><------><------>adcsel & WM97XX_ADCSEL_MASK, |
| <------><------><------>*sample & WM97XX_ADCSEL_MASK); |
| <------><------>return RC_PENUP; |
| <------>} |
| |
| <------>if (wants_pen && !(*sample & WM97XX_PEN_DOWN)) { |
| <------><------>wm->pen_probably_down = 0; |
| <------><------>return RC_PENUP; |
| <------>} |
| |
| <------>return RC_VALID; |
| } |
| |
| |
| |
| |
| static int wm9705_poll_touch(struct wm97xx *wm, struct wm97xx_data *data) |
| { |
| <------>int rc; |
| |
| <------>rc = wm9705_poll_sample(wm, WM97XX_ADCSEL_X | WM97XX_PEN_DOWN, &data->x); |
| <------>if (rc != RC_VALID) |
| <------><------>return rc; |
| <------>rc = wm9705_poll_sample(wm, WM97XX_ADCSEL_Y | WM97XX_PEN_DOWN, &data->y); |
| <------>if (rc != RC_VALID) |
| <------><------>return rc; |
| <------>if (pil) { |
| <------><------>rc = wm9705_poll_sample(wm, WM97XX_ADCSEL_PRES | WM97XX_PEN_DOWN, &data->p); |
| <------><------>if (rc != RC_VALID) |
| <------><------><------>return rc; |
| <------>} else |
| <------><------>data->p = DEFAULT_PRESSURE; |
| |
| <------>return RC_VALID; |
| } |
| |
| |
| |
| |
| |
| static int wm9705_acc_enable(struct wm97xx *wm, int enable) |
| { |
| <------>u16 dig1, dig2; |
| <------>int ret = 0; |
| |
| <------>dig1 = wm->dig[1]; |
| <------>dig2 = wm->dig[2]; |
| |
| <------>if (enable) { |
| <------><------> |
| <------><------>if (wm->mach_ops->acc_startup && |
| <------><------> (ret = wm->mach_ops->acc_startup(wm)) < 0) |
| <------><------><------>return ret; |
| <------><------>dig1 &= ~(WM97XX_CM_RATE_MASK | WM97XX_ADCSEL_MASK | |
| <------><------><------> WM97XX_DELAY_MASK | WM97XX_SLT_MASK); |
| <------><------>dig1 |= WM97XX_CTC | WM97XX_COO | WM97XX_SLEN | |
| <------><------><------>WM97XX_DELAY(delay) | |
| <------><------><------>WM97XX_SLT(wm->acc_slot) | |
| <------><------><------>WM97XX_RATE(wm->acc_rate); |
| <------><------>if (pil) |
| <------><------><------>dig1 |= WM97XX_ADCSEL_PRES; |
| <------><------>dig2 |= WM9705_PDEN; |
| <------>} else { |
| <------><------>dig1 &= ~(WM97XX_CTC | WM97XX_COO | WM97XX_SLEN); |
| <------><------>dig2 &= ~WM9705_PDEN; |
| <------><------>if (wm->mach_ops->acc_shutdown) |
| <------><------><------>wm->mach_ops->acc_shutdown(wm); |
| <------>} |
| |
| <------>wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER1, dig1); |
| <------>wm97xx_reg_write(wm, AC97_WM97XX_DIGITISER2, dig2); |
| |
| <------>return ret; |
| } |
| |
| struct wm97xx_codec_drv wm9705_codec = { |
| <------>.id = WM9705_ID2, |
| <------>.name = "wm9705", |
| <------>.poll_sample = wm9705_poll_sample, |
| <------>.poll_touch = wm9705_poll_touch, |
| <------>.acc_enable = wm9705_acc_enable, |
| <------>.phy_init = wm9705_phy_init, |
| <------>.dig_enable = wm9705_dig_enable, |
| <------>.dig_restore = wm9705_dig_restore, |
| <------>.aux_prepare = wm9705_aux_prepare, |
| }; |
| EXPORT_SYMBOL_GPL(wm9705_codec); |
| |
| |
| MODULE_AUTHOR("Liam Girdwood <lrg@slimlogic.co.uk>"); |
| MODULE_DESCRIPTION("WM9705 Touch Screen Driver"); |
| MODULE_LICENSE("GPL"); |
| |