Lines Matching refs:cd
84 static int cyttsp4_load_status_regs(struct cyttsp4 *cd) in cyttsp4_load_status_regs() argument
86 struct cyttsp4_sysinfo *si = &cd->sysinfo; in cyttsp4_load_status_regs()
87 struct device *dev = cd->dev; in cyttsp4_load_status_regs()
90 rc = cyttsp4_adap_read(cd, CY_REG_BASE, si->si_ofs.mode_size, in cyttsp4_load_status_regs()
96 cyttsp4_pr_buf(dev, cd->pr_buf, si->xy_mode, in cyttsp4_load_status_regs()
102 static int cyttsp4_handshake(struct cyttsp4 *cd, u8 mode) in cyttsp4_handshake() argument
114 rc = cyttsp4_adap_write(cd, CY_REG_BASE, sizeof(cmd), &cmd); in cyttsp4_handshake()
116 dev_err(cd->dev, "%s: bus write fail on handshake (ret=%d)\n", in cyttsp4_handshake()
122 static int cyttsp4_hw_soft_reset(struct cyttsp4 *cd) in cyttsp4_hw_soft_reset() argument
125 int rc = cyttsp4_adap_write(cd, CY_REG_BASE, sizeof(cmd), &cmd); in cyttsp4_hw_soft_reset()
127 dev_err(cd->dev, "%s: FAILED to execute SOFT reset\n", in cyttsp4_hw_soft_reset()
134 static int cyttsp4_hw_hard_reset(struct cyttsp4 *cd) in cyttsp4_hw_hard_reset() argument
136 if (cd->cpdata->xres) { in cyttsp4_hw_hard_reset()
137 cd->cpdata->xres(cd->cpdata, cd->dev); in cyttsp4_hw_hard_reset()
138 dev_dbg(cd->dev, "%s: execute HARD reset\n", __func__); in cyttsp4_hw_hard_reset()
141 dev_err(cd->dev, "%s: FAILED to execute HARD reset\n", __func__); in cyttsp4_hw_hard_reset()
145 static int cyttsp4_hw_reset(struct cyttsp4 *cd) in cyttsp4_hw_reset() argument
147 int rc = cyttsp4_hw_hard_reset(cd); in cyttsp4_hw_reset()
149 rc = cyttsp4_hw_soft_reset(cd); in cyttsp4_hw_reset()
164 static int cyttsp4_si_data_offsets(struct cyttsp4 *cd) in cyttsp4_si_data_offsets() argument
166 struct cyttsp4_sysinfo *si = &cd->sysinfo; in cyttsp4_si_data_offsets()
167 int rc = cyttsp4_adap_read(cd, CY_REG_BASE, sizeof(si->si_data), in cyttsp4_si_data_offsets()
170 dev_err(cd->dev, "%s: fail read sysinfo data offsets r=%d\n", in cyttsp4_si_data_offsets()
176 cyttsp4_pr_buf(cd->dev, cd->pr_buf, (u8 *)&si->si_data, in cyttsp4_si_data_offsets()
200 static int cyttsp4_si_get_cydata(struct cyttsp4 *cd) in cyttsp4_si_get_cydata() argument
202 struct cyttsp4_sysinfo *si = &cd->sysinfo; in cyttsp4_si_get_cydata()
209 dev_err(cd->dev, in cyttsp4_si_get_cydata()
216 dev_dbg(cd->dev, "%s: cydata size: %zd\n", __func__, in cyttsp4_si_get_cydata()
221 dev_err(cd->dev, "%s: failed to allocate cydata memory\n", in cyttsp4_si_get_cydata()
230 rc = cyttsp4_adap_read(cd, read_offset, in cyttsp4_si_get_cydata()
235 dev_err(cd->dev, "%s: fail read cydata r=%d\n", in cyttsp4_si_get_cydata()
244 dev_err(cd->dev, "%s: mismatch in MFGID size, reported:%d calculated:%d\n", in cyttsp4_si_get_cydata()
253 rc = cyttsp4_adap_read(cd, read_offset, si->si_ptrs.cydata->mfgid_sz, in cyttsp4_si_get_cydata()
256 dev_err(cd->dev, "%s: fail read cydata r=%d\n", in cyttsp4_si_get_cydata()
264 rc = cyttsp4_adap_read(cd, read_offset, in cyttsp4_si_get_cydata()
269 dev_err(cd->dev, "%s: fail read cydata r=%d\n", in cyttsp4_si_get_cydata()
274 cyttsp4_pr_buf(cd->dev, cd->pr_buf, (u8 *)si->si_ptrs.cydata, in cyttsp4_si_get_cydata()
279 static int cyttsp4_si_get_test_data(struct cyttsp4 *cd) in cyttsp4_si_get_test_data() argument
281 struct cyttsp4_sysinfo *si = &cd->sysinfo; in cyttsp4_si_get_test_data()
286 dev_err(cd->dev, in cyttsp4_si_get_test_data()
296 dev_err(cd->dev, "%s: failed to allocate test memory\n", in cyttsp4_si_get_test_data()
302 rc = cyttsp4_adap_read(cd, si->si_ofs.test_ofs, si->si_ofs.test_size, in cyttsp4_si_get_test_data()
305 dev_err(cd->dev, "%s: fail read test data r=%d\n", in cyttsp4_si_get_test_data()
310 cyttsp4_pr_buf(cd->dev, cd->pr_buf, in cyttsp4_si_get_test_data()
315 dev_info(cd->dev, "%s: %s codel=%02X\n", in cyttsp4_si_get_test_data()
321 dev_info(cd->dev, "%s: %s codel=%02X\n", __func__, in cyttsp4_si_get_test_data()
327 dev_info(cd->dev, "%s: %s codel=%02X\n", in cyttsp4_si_get_test_data()
331 dev_info(cd->dev, "%s: SCANNING is %s codel=%02X\n", in cyttsp4_si_get_test_data()
338 static int cyttsp4_si_get_pcfg_data(struct cyttsp4 *cd) in cyttsp4_si_get_pcfg_data() argument
340 struct cyttsp4_sysinfo *si = &cd->sysinfo; in cyttsp4_si_get_pcfg_data()
345 dev_err(cd->dev, in cyttsp4_si_get_pcfg_data()
355 dev_err(cd->dev, "%s: failed to allocate pcfg memory\n", in cyttsp4_si_get_pcfg_data()
361 rc = cyttsp4_adap_read(cd, si->si_ofs.pcfg_ofs, si->si_ofs.pcfg_size, in cyttsp4_si_get_pcfg_data()
364 dev_err(cd->dev, "%s: fail read pcfg data r=%d\n", in cyttsp4_si_get_pcfg_data()
380 cyttsp4_pr_buf(cd->dev, cd->pr_buf, in cyttsp4_si_get_pcfg_data()
386 static int cyttsp4_si_get_opcfg_data(struct cyttsp4 *cd) in cyttsp4_si_get_opcfg_data() argument
388 struct cyttsp4_sysinfo *si = &cd->sysinfo; in cyttsp4_si_get_opcfg_data()
397 dev_err(cd->dev, in cyttsp4_si_get_opcfg_data()
407 dev_err(cd->dev, "%s: failed to allocate opcfg memory\n", in cyttsp4_si_get_opcfg_data()
413 rc = cyttsp4_adap_read(cd, si->si_ofs.opcfg_ofs, si->si_ofs.opcfg_size, in cyttsp4_si_get_opcfg_data()
416 dev_err(cd->dev, "%s: fail read opcfg data r=%d\n", in cyttsp4_si_get_opcfg_data()
464 dev_dbg(cd->dev, "%s: tch_rec_%s\n", __func__, in cyttsp4_si_get_opcfg_data()
466 dev_dbg(cd->dev, "%s: ofs =%2zd\n", __func__, in cyttsp4_si_get_opcfg_data()
468 dev_dbg(cd->dev, "%s: siz =%2zd\n", __func__, in cyttsp4_si_get_opcfg_data()
470 dev_dbg(cd->dev, "%s: max =%2zd\n", __func__, in cyttsp4_si_get_opcfg_data()
472 dev_dbg(cd->dev, "%s: bofs=%2zd\n", __func__, in cyttsp4_si_get_opcfg_data()
480 cyttsp4_pr_buf(cd->dev, cd->pr_buf, (u8 *)si->si_ptrs.opcfg, in cyttsp4_si_get_opcfg_data()
486 static int cyttsp4_si_get_ddata(struct cyttsp4 *cd) in cyttsp4_si_get_ddata() argument
488 struct cyttsp4_sysinfo *si = &cd->sysinfo; in cyttsp4_si_get_ddata()
496 dev_err(cd->dev, "%s: fail alloc ddata memory\n", __func__); in cyttsp4_si_get_ddata()
501 rc = cyttsp4_adap_read(cd, si->si_ofs.ddata_ofs, si->si_ofs.ddata_size, in cyttsp4_si_get_ddata()
504 dev_err(cd->dev, "%s: fail read ddata data r=%d\n", in cyttsp4_si_get_ddata()
507 cyttsp4_pr_buf(cd->dev, cd->pr_buf, in cyttsp4_si_get_ddata()
513 static int cyttsp4_si_get_mdata(struct cyttsp4 *cd) in cyttsp4_si_get_mdata() argument
515 struct cyttsp4_sysinfo *si = &cd->sysinfo; in cyttsp4_si_get_mdata()
523 dev_err(cd->dev, "%s: fail alloc mdata memory\n", __func__); in cyttsp4_si_get_mdata()
528 rc = cyttsp4_adap_read(cd, si->si_ofs.mdata_ofs, si->si_ofs.mdata_size, in cyttsp4_si_get_mdata()
531 dev_err(cd->dev, "%s: fail read mdata data r=%d\n", in cyttsp4_si_get_mdata()
534 cyttsp4_pr_buf(cd->dev, cd->pr_buf, in cyttsp4_si_get_mdata()
540 static int cyttsp4_si_get_btn_data(struct cyttsp4 *cd) in cyttsp4_si_get_btn_data() argument
542 struct cyttsp4_sysinfo *si = &cd->sysinfo; in cyttsp4_si_get_btn_data()
556 dev_err(cd->dev, "%s: %s\n", __func__, in cyttsp4_si_get_btn_data()
562 if (cd->cpdata->sett[CY_IC_GRPNUM_BTN_KEYS] == NULL) in cyttsp4_si_get_btn_data()
564 else if (cd->cpdata->sett[CY_IC_GRPNUM_BTN_KEYS]->data == NULL) in cyttsp4_si_get_btn_data()
567 num_defined_keys = cd->cpdata->sett in cyttsp4_si_get_btn_data()
572 key_table = (u16 *)cd->cpdata->sett in cyttsp4_si_get_btn_data()
593 static int cyttsp4_si_get_op_data_ptrs(struct cyttsp4 *cd) in cyttsp4_si_get_op_data_ptrs() argument
595 struct cyttsp4_sysinfo *si = &cd->sysinfo; in cyttsp4_si_get_op_data_ptrs()
618 static void cyttsp4_si_put_log_data(struct cyttsp4 *cd) in cyttsp4_si_put_log_data() argument
620 struct cyttsp4_sysinfo *si = &cd->sysinfo; in cyttsp4_si_put_log_data()
621 dev_dbg(cd->dev, "%s: cydata_ofs =%4zd siz=%4zd\n", __func__, in cyttsp4_si_put_log_data()
623 dev_dbg(cd->dev, "%s: test_ofs =%4zd siz=%4zd\n", __func__, in cyttsp4_si_put_log_data()
625 dev_dbg(cd->dev, "%s: pcfg_ofs =%4zd siz=%4zd\n", __func__, in cyttsp4_si_put_log_data()
627 dev_dbg(cd->dev, "%s: opcfg_ofs =%4zd siz=%4zd\n", __func__, in cyttsp4_si_put_log_data()
629 dev_dbg(cd->dev, "%s: ddata_ofs =%4zd siz=%4zd\n", __func__, in cyttsp4_si_put_log_data()
631 dev_dbg(cd->dev, "%s: mdata_ofs =%4zd siz=%4zd\n", __func__, in cyttsp4_si_put_log_data()
634 dev_dbg(cd->dev, "%s: cmd_ofs =%4zd\n", __func__, in cyttsp4_si_put_log_data()
636 dev_dbg(cd->dev, "%s: rep_ofs =%4zd\n", __func__, in cyttsp4_si_put_log_data()
638 dev_dbg(cd->dev, "%s: rep_sz =%4zd\n", __func__, in cyttsp4_si_put_log_data()
640 dev_dbg(cd->dev, "%s: num_btns =%4zd\n", __func__, in cyttsp4_si_put_log_data()
642 dev_dbg(cd->dev, "%s: num_btn_regs =%4zd\n", __func__, in cyttsp4_si_put_log_data()
644 dev_dbg(cd->dev, "%s: tt_stat_ofs =%4zd\n", __func__, in cyttsp4_si_put_log_data()
646 dev_dbg(cd->dev, "%s: tch_rec_size =%4zd\n", __func__, in cyttsp4_si_put_log_data()
648 dev_dbg(cd->dev, "%s: max_tchs =%4zd\n", __func__, in cyttsp4_si_put_log_data()
650 dev_dbg(cd->dev, "%s: mode_size =%4zd\n", __func__, in cyttsp4_si_put_log_data()
652 dev_dbg(cd->dev, "%s: data_size =%4zd\n", __func__, in cyttsp4_si_put_log_data()
654 dev_dbg(cd->dev, "%s: map_sz =%4zd\n", __func__, in cyttsp4_si_put_log_data()
657 dev_dbg(cd->dev, "%s: btn_rec_size =%2zd\n", __func__, in cyttsp4_si_put_log_data()
659 dev_dbg(cd->dev, "%s: btn_diff_ofs =%2zd\n", __func__, in cyttsp4_si_put_log_data()
661 dev_dbg(cd->dev, "%s: btn_diff_size =%2zd\n", __func__, in cyttsp4_si_put_log_data()
664 dev_dbg(cd->dev, "%s: max_x = 0x%04zX (%zd)\n", __func__, in cyttsp4_si_put_log_data()
666 dev_dbg(cd->dev, "%s: x_origin = %zd (%s)\n", __func__, in cyttsp4_si_put_log_data()
670 dev_dbg(cd->dev, "%s: max_y = 0x%04zX (%zd)\n", __func__, in cyttsp4_si_put_log_data()
672 dev_dbg(cd->dev, "%s: y_origin = %zd (%s)\n", __func__, in cyttsp4_si_put_log_data()
676 dev_dbg(cd->dev, "%s: max_p = 0x%04zX (%zd)\n", __func__, in cyttsp4_si_put_log_data()
679 dev_dbg(cd->dev, "%s: xy_mode=%p xy_data=%p\n", __func__, in cyttsp4_si_put_log_data()
683 static int cyttsp4_get_sysinfo_regs(struct cyttsp4 *cd) in cyttsp4_get_sysinfo_regs() argument
685 struct cyttsp4_sysinfo *si = &cd->sysinfo; in cyttsp4_get_sysinfo_regs()
688 rc = cyttsp4_si_data_offsets(cd); in cyttsp4_get_sysinfo_regs()
692 rc = cyttsp4_si_get_cydata(cd); in cyttsp4_get_sysinfo_regs()
696 rc = cyttsp4_si_get_test_data(cd); in cyttsp4_get_sysinfo_regs()
700 rc = cyttsp4_si_get_pcfg_data(cd); in cyttsp4_get_sysinfo_regs()
704 rc = cyttsp4_si_get_opcfg_data(cd); in cyttsp4_get_sysinfo_regs()
708 rc = cyttsp4_si_get_ddata(cd); in cyttsp4_get_sysinfo_regs()
712 rc = cyttsp4_si_get_mdata(cd); in cyttsp4_get_sysinfo_regs()
716 rc = cyttsp4_si_get_btn_data(cd); in cyttsp4_get_sysinfo_regs()
720 rc = cyttsp4_si_get_op_data_ptrs(cd); in cyttsp4_get_sysinfo_regs()
722 dev_err(cd->dev, "%s: failed to get_op_data\n", in cyttsp4_get_sysinfo_regs()
727 cyttsp4_si_put_log_data(cd); in cyttsp4_get_sysinfo_regs()
730 rc = cyttsp4_handshake(cd, si->si_data.hst_mode); in cyttsp4_get_sysinfo_regs()
732 dev_err(cd->dev, "%s: handshake fail on sysinfo reg\n", in cyttsp4_get_sysinfo_regs()
739 static void cyttsp4_queue_startup_(struct cyttsp4 *cd) in cyttsp4_queue_startup_() argument
741 if (cd->startup_state == STARTUP_NONE) { in cyttsp4_queue_startup_()
742 cd->startup_state = STARTUP_QUEUED; in cyttsp4_queue_startup_()
743 schedule_work(&cd->startup_work); in cyttsp4_queue_startup_()
744 dev_dbg(cd->dev, "%s: cyttsp4_startup queued\n", __func__); in cyttsp4_queue_startup_()
746 dev_dbg(cd->dev, "%s: startup_state = %d\n", __func__, in cyttsp4_queue_startup_()
747 cd->startup_state); in cyttsp4_queue_startup_()
967 static int cyttsp4_xy_worker(struct cyttsp4 *cd) in cyttsp4_xy_worker() argument
969 struct cyttsp4_mt_data *md = &cd->md; in cyttsp4_xy_worker()
1009 rc = cyttsp4_adap_read(cd, si->si_ofs.tt_stat_ofs + 1, in cyttsp4_xy_worker()
1020 cyttsp4_pr_buf(dev, cd->pr_buf, si->xy_data, num_cur_tch * in cyttsp4_xy_worker()
1053 static int cyttsp4_mt_attention(struct cyttsp4 *cd) in cyttsp4_mt_attention() argument
1055 struct device *dev = cd->dev; in cyttsp4_mt_attention()
1056 struct cyttsp4_mt_data *md = &cd->md; in cyttsp4_mt_attention()
1065 rc = cyttsp4_xy_worker(cd); in cyttsp4_mt_attention()
1079 struct cyttsp4 *cd = handle; in cyttsp4_irq() local
1080 struct device *dev = cd->dev; in cyttsp4_irq()
1082 u8 cmd_ofs = cd->sysinfo.si_ofs.cmd_ofs; in cyttsp4_irq()
1091 if (atomic_read(&cd->ignore_irq)) { in cyttsp4_irq()
1096 dev_dbg(dev, "%s int:0x%x\n", __func__, cd->int_status); in cyttsp4_irq()
1098 mutex_lock(&cd->system_lock); in cyttsp4_irq()
1101 if (cd->sleep_state == SS_SLEEP_ON || cd->sleep_state == SS_SLEEPING) in cyttsp4_irq()
1104 rc = cyttsp4_adap_read(cd, CY_REG_BASE, sizeof(mode), mode); in cyttsp4_irq()
1106 dev_err(cd->dev, "%s: Fail read adapter r=%d\n", __func__, rc); in cyttsp4_irq()
1115 if (cd->mode == CY_MODE_BOOTLOADER) { in cyttsp4_irq()
1117 wake_up(&cd->wait_q); in cyttsp4_irq()
1123 __func__, cd->mode, cur_mode); in cyttsp4_irq()
1126 if (cd->mode != CY_MODE_UNKNOWN) { in cyttsp4_irq()
1128 cd->mode = CY_MODE_UNKNOWN; in cyttsp4_irq()
1129 cyttsp4_queue_startup_(cd); in cyttsp4_irq()
1138 cd->mode = cur_mode; in cyttsp4_irq()
1164 if (cd->int_status & CY_INT_IGNORE) { in cyttsp4_irq()
1170 if (cd->int_status & CY_INT_AWAKE) { in cyttsp4_irq()
1171 cd->int_status &= ~CY_INT_AWAKE; in cyttsp4_irq()
1172 wake_up(&cd->wait_q); in cyttsp4_irq()
1178 if ((cd->int_status & CY_INT_MODE_CHANGE) in cyttsp4_irq()
1180 cd->int_status &= ~CY_INT_MODE_CHANGE; in cyttsp4_irq()
1182 __func__, cd->mode, cur_mode); in cyttsp4_irq()
1183 cd->mode = cur_mode; in cyttsp4_irq()
1184 wake_up(&cd->wait_q); in cyttsp4_irq()
1190 __func__, cd->mode, cur_mode); in cyttsp4_irq()
1191 if ((mode[0] & CY_HST_MODE_CHANGE) == 0 && cd->mode != cur_mode) { in cyttsp4_irq()
1193 dev_err(dev, "%s %d->%d 0x%x\n", __func__, cd->mode, in cyttsp4_irq()
1194 cur_mode, cd->int_status); in cyttsp4_irq()
1197 cyttsp4_queue_startup_(cd); in cyttsp4_irq()
1203 if ((cd->int_status & CY_INT_EXEC_CMD) in cyttsp4_irq()
1205 cd->int_status &= ~CY_INT_EXEC_CMD; in cyttsp4_irq()
1208 wake_up(&cd->wait_q); in cyttsp4_irq()
1217 if (cd->mode == CY_MODE_OPERATIONAL) { in cyttsp4_irq()
1219 rc = cyttsp4_load_status_regs(cd); in cyttsp4_irq()
1225 cyttsp4_mt_attention(cd); in cyttsp4_irq()
1231 rc = cyttsp4_handshake(cd, mode[0]); in cyttsp4_irq()
1241 udelay(cd->cpdata->level_irq_udelay); in cyttsp4_irq()
1244 mutex_unlock(&cd->system_lock); in cyttsp4_irq()
1248 static void cyttsp4_start_wd_timer(struct cyttsp4 *cd) in cyttsp4_start_wd_timer() argument
1253 mod_timer(&cd->watchdog_timer, jiffies + in cyttsp4_start_wd_timer()
1257 static void cyttsp4_stop_wd_timer(struct cyttsp4 *cd) in cyttsp4_stop_wd_timer() argument
1266 del_timer_sync(&cd->watchdog_timer); in cyttsp4_stop_wd_timer()
1267 cancel_work_sync(&cd->watchdog_work); in cyttsp4_stop_wd_timer()
1268 del_timer_sync(&cd->watchdog_timer); in cyttsp4_stop_wd_timer()
1273 struct cyttsp4 *cd = from_timer(cd, t, watchdog_timer); in cyttsp4_watchdog_timer() local
1275 dev_vdbg(cd->dev, "%s: Watchdog timer triggered\n", __func__); in cyttsp4_watchdog_timer()
1277 schedule_work(&cd->watchdog_work); in cyttsp4_watchdog_timer()
1282 static int cyttsp4_request_exclusive(struct cyttsp4 *cd, void *ownptr, in cyttsp4_request_exclusive() argument
1288 mutex_lock(&cd->system_lock); in cyttsp4_request_exclusive()
1289 if (!cd->exclusive_dev && cd->exclusive_waits == 0) { in cyttsp4_request_exclusive()
1290 cd->exclusive_dev = ownptr; in cyttsp4_request_exclusive()
1294 cd->exclusive_waits++; in cyttsp4_request_exclusive()
1296 mutex_unlock(&cd->system_lock); in cyttsp4_request_exclusive()
1298 t = wait_event_timeout(cd->wait_q, !cd->exclusive_dev, t); in cyttsp4_request_exclusive()
1300 dev_err(cd->dev, "%s: tmo waiting exclusive access\n", in cyttsp4_request_exclusive()
1302 mutex_lock(&cd->system_lock); in cyttsp4_request_exclusive()
1303 cd->exclusive_waits--; in cyttsp4_request_exclusive()
1304 mutex_unlock(&cd->system_lock); in cyttsp4_request_exclusive()
1308 wait_event(cd->wait_q, !cd->exclusive_dev); in cyttsp4_request_exclusive()
1310 mutex_lock(&cd->system_lock); in cyttsp4_request_exclusive()
1311 if (cd->exclusive_dev) in cyttsp4_request_exclusive()
1313 cd->exclusive_dev = ownptr; in cyttsp4_request_exclusive()
1314 cd->exclusive_waits--; in cyttsp4_request_exclusive()
1316 mutex_unlock(&cd->system_lock); in cyttsp4_request_exclusive()
1324 static int cyttsp4_release_exclusive(struct cyttsp4 *cd, void *ownptr) in cyttsp4_release_exclusive() argument
1326 mutex_lock(&cd->system_lock); in cyttsp4_release_exclusive()
1327 if (cd->exclusive_dev != ownptr) { in cyttsp4_release_exclusive()
1328 mutex_unlock(&cd->system_lock); in cyttsp4_release_exclusive()
1332 dev_vdbg(cd->dev, "%s: exclusive_dev %p freed\n", in cyttsp4_release_exclusive()
1333 __func__, cd->exclusive_dev); in cyttsp4_release_exclusive()
1334 cd->exclusive_dev = NULL; in cyttsp4_release_exclusive()
1335 wake_up(&cd->wait_q); in cyttsp4_release_exclusive()
1336 mutex_unlock(&cd->system_lock); in cyttsp4_release_exclusive()
1340 static int cyttsp4_wait_bl_heartbeat(struct cyttsp4 *cd) in cyttsp4_wait_bl_heartbeat() argument
1346 dev_vdbg(cd->dev, "%s: wait heartbeat...\n", __func__); in cyttsp4_wait_bl_heartbeat()
1347 t = wait_event_timeout(cd->wait_q, cd->mode == CY_MODE_BOOTLOADER, in cyttsp4_wait_bl_heartbeat()
1350 dev_err(cd->dev, "%s: tmo waiting bl heartbeat cd->mode=%d\n", in cyttsp4_wait_bl_heartbeat()
1351 __func__, cd->mode); in cyttsp4_wait_bl_heartbeat()
1358 static int cyttsp4_wait_sysinfo_mode(struct cyttsp4 *cd) in cyttsp4_wait_sysinfo_mode() argument
1362 dev_vdbg(cd->dev, "%s: wait sysinfo...\n", __func__); in cyttsp4_wait_sysinfo_mode()
1364 t = wait_event_timeout(cd->wait_q, cd->mode == CY_MODE_SYSINFO, in cyttsp4_wait_sysinfo_mode()
1367 dev_err(cd->dev, "%s: tmo waiting exit bl cd->mode=%d\n", in cyttsp4_wait_sysinfo_mode()
1368 __func__, cd->mode); in cyttsp4_wait_sysinfo_mode()
1369 mutex_lock(&cd->system_lock); in cyttsp4_wait_sysinfo_mode()
1370 cd->int_status &= ~CY_INT_MODE_CHANGE; in cyttsp4_wait_sysinfo_mode()
1371 mutex_unlock(&cd->system_lock); in cyttsp4_wait_sysinfo_mode()
1378 static int cyttsp4_reset_and_wait(struct cyttsp4 *cd) in cyttsp4_reset_and_wait() argument
1383 mutex_lock(&cd->system_lock); in cyttsp4_reset_and_wait()
1384 dev_dbg(cd->dev, "%s: reset hw...\n", __func__); in cyttsp4_reset_and_wait()
1385 rc = cyttsp4_hw_reset(cd); in cyttsp4_reset_and_wait()
1386 cd->mode = CY_MODE_UNKNOWN; in cyttsp4_reset_and_wait()
1387 mutex_unlock(&cd->system_lock); in cyttsp4_reset_and_wait()
1389 dev_err(cd->dev, "%s:Fail hw reset r=%d\n", __func__, rc); in cyttsp4_reset_and_wait()
1393 return cyttsp4_wait_bl_heartbeat(cd); in cyttsp4_reset_and_wait()
1400 static int cyttsp4_set_mode(struct cyttsp4 *cd, int new_mode) in cyttsp4_set_mode() argument
1418 dev_err(cd->dev, "%s: invalid mode: %02X(%d)\n", in cyttsp4_set_mode()
1424 dev_dbg(cd->dev, "%s: %s=%p new_dev_mode=%02X new_mode=%d\n", in cyttsp4_set_mode()
1425 __func__, "have exclusive", cd->exclusive_dev, in cyttsp4_set_mode()
1428 mutex_lock(&cd->system_lock); in cyttsp4_set_mode()
1429 rc = cyttsp4_adap_read(cd, CY_REG_BASE, sizeof(mode), &mode); in cyttsp4_set_mode()
1431 mutex_unlock(&cd->system_lock); in cyttsp4_set_mode()
1432 dev_err(cd->dev, "%s: Fail read mode r=%d\n", in cyttsp4_set_mode()
1441 cd->int_status |= CY_INT_MODE_CHANGE; in cyttsp4_set_mode()
1442 rc = cyttsp4_adap_write(cd, CY_REG_BASE, sizeof(mode), &mode); in cyttsp4_set_mode()
1443 mutex_unlock(&cd->system_lock); in cyttsp4_set_mode()
1445 dev_err(cd->dev, "%s: Fail write mode change r=%d\n", in cyttsp4_set_mode()
1451 t = wait_event_timeout(cd->wait_q, in cyttsp4_set_mode()
1452 (cd->int_status & CY_INT_MODE_CHANGE) == 0, in cyttsp4_set_mode()
1454 dev_dbg(cd->dev, "%s: back from wait t=%ld cd->mode=%d\n", in cyttsp4_set_mode()
1455 __func__, t, cd->mode); in cyttsp4_set_mode()
1458 dev_err(cd->dev, "%s: %s\n", __func__, in cyttsp4_set_mode()
1460 mutex_lock(&cd->system_lock); in cyttsp4_set_mode()
1461 cd->int_status &= ~CY_INT_MODE_CHANGE; in cyttsp4_set_mode()
1462 mutex_unlock(&cd->system_lock); in cyttsp4_set_mode()
1472 struct cyttsp4 *cd = in cyttsp4_watchdog_work() local
1477 mutex_lock(&cd->system_lock); in cyttsp4_watchdog_work()
1478 retval = cyttsp4_load_status_regs(cd); in cyttsp4_watchdog_work()
1480 dev_err(cd->dev, in cyttsp4_watchdog_work()
1483 cyttsp4_queue_startup_(cd); in cyttsp4_watchdog_work()
1486 mode = &cd->sysinfo.xy_mode[CY_REG_BASE]; in cyttsp4_watchdog_work()
1488 dev_err(cd->dev, in cyttsp4_watchdog_work()
1491 cyttsp4_queue_startup_(cd); in cyttsp4_watchdog_work()
1495 cyttsp4_start_wd_timer(cd); in cyttsp4_watchdog_work()
1497 mutex_unlock(&cd->system_lock); in cyttsp4_watchdog_work()
1501 static int cyttsp4_core_sleep_(struct cyttsp4 *cd) in cyttsp4_core_sleep_() argument
1509 mutex_lock(&cd->system_lock); in cyttsp4_core_sleep_()
1510 if (cd->sleep_state == SS_SLEEP_ON) { in cyttsp4_core_sleep_()
1511 mutex_unlock(&cd->system_lock); in cyttsp4_core_sleep_()
1514 cd->sleep_state = SS_SLEEPING; in cyttsp4_core_sleep_()
1515 mutex_unlock(&cd->system_lock); in cyttsp4_core_sleep_()
1517 cyttsp4_stop_wd_timer(cd); in cyttsp4_core_sleep_()
1520 disable_irq(cd->irq); in cyttsp4_core_sleep_()
1522 dev_vdbg(cd->dev, "%s: write DEEP SLEEP...\n", __func__); in cyttsp4_core_sleep_()
1523 mutex_lock(&cd->system_lock); in cyttsp4_core_sleep_()
1524 rc = cyttsp4_adap_read(cd, CY_REG_BASE, sizeof(mode), &mode); in cyttsp4_core_sleep_()
1526 mutex_unlock(&cd->system_lock); in cyttsp4_core_sleep_()
1527 dev_err(cd->dev, "%s: Fail read adapter r=%d\n", __func__, rc); in cyttsp4_core_sleep_()
1532 mutex_unlock(&cd->system_lock); in cyttsp4_core_sleep_()
1533 dev_err(cd->dev, "%s: Device in BOOTLOADER mode.\n", __func__); in cyttsp4_core_sleep_()
1539 rc = cyttsp4_adap_write(cd, CY_REG_BASE, sizeof(mode[0]), &mode[0]); in cyttsp4_core_sleep_()
1540 mutex_unlock(&cd->system_lock); in cyttsp4_core_sleep_()
1542 dev_err(cd->dev, "%s: Fail write adapter r=%d\n", __func__, rc); in cyttsp4_core_sleep_()
1545 dev_vdbg(cd->dev, "%s: write DEEP SLEEP succeeded\n", __func__); in cyttsp4_core_sleep_()
1547 if (cd->cpdata->power) { in cyttsp4_core_sleep_()
1548 dev_dbg(cd->dev, "%s: Power down HW\n", __func__); in cyttsp4_core_sleep_()
1549 rc = cd->cpdata->power(cd->cpdata, 0, cd->dev, &cd->ignore_irq); in cyttsp4_core_sleep_()
1551 dev_dbg(cd->dev, "%s: No power function\n", __func__); in cyttsp4_core_sleep_()
1555 dev_err(cd->dev, "%s: HW Power down fails r=%d\n", in cyttsp4_core_sleep_()
1568 cyttsp4_start_wd_timer(cd); in cyttsp4_core_sleep_()
1571 mutex_lock(&cd->system_lock); in cyttsp4_core_sleep_()
1572 cd->sleep_state = ss; in cyttsp4_core_sleep_()
1573 cd->int_status |= int_status; in cyttsp4_core_sleep_()
1574 mutex_unlock(&cd->system_lock); in cyttsp4_core_sleep_()
1575 enable_irq(cd->irq); in cyttsp4_core_sleep_()
1579 static int cyttsp4_startup_(struct cyttsp4 *cd) in cyttsp4_startup_() argument
1584 cyttsp4_stop_wd_timer(cd); in cyttsp4_startup_()
1588 dev_dbg(cd->dev, "%s: Retry %d\n", __func__, in cyttsp4_startup_()
1592 rc = cyttsp4_reset_and_wait(cd); in cyttsp4_startup_()
1594 dev_err(cd->dev, "%s: Error on h/w reset r=%d\n", __func__, rc); in cyttsp4_startup_()
1601 dev_vdbg(cd->dev, "%s: write exit ldr...\n", __func__); in cyttsp4_startup_()
1602 mutex_lock(&cd->system_lock); in cyttsp4_startup_()
1603 cd->int_status &= ~CY_INT_IGNORE; in cyttsp4_startup_()
1604 cd->int_status |= CY_INT_MODE_CHANGE; in cyttsp4_startup_()
1606 rc = cyttsp4_adap_write(cd, CY_REG_BASE, sizeof(ldr_exit), in cyttsp4_startup_()
1608 mutex_unlock(&cd->system_lock); in cyttsp4_startup_()
1610 dev_err(cd->dev, "%s: Fail write r=%d\n", __func__, rc); in cyttsp4_startup_()
1616 rc = cyttsp4_wait_sysinfo_mode(cd); in cyttsp4_startup_()
1622 rc1 = cyttsp4_adap_read(cd, CY_REG_BASE, sizeof(ldr_err_app), in cyttsp4_startup_()
1625 dev_err(cd->dev, "%s: Fail read r=%d\n", __func__, rc1); in cyttsp4_startup_()
1627 dev_err(cd->dev, "%s: Error launching touch application\n", in cyttsp4_startup_()
1629 mutex_lock(&cd->system_lock); in cyttsp4_startup_()
1630 cd->invalid_touch_app = true; in cyttsp4_startup_()
1631 mutex_unlock(&cd->system_lock); in cyttsp4_startup_()
1640 mutex_lock(&cd->system_lock); in cyttsp4_startup_()
1641 cd->invalid_touch_app = false; in cyttsp4_startup_()
1642 mutex_unlock(&cd->system_lock); in cyttsp4_startup_()
1645 dev_vdbg(cd->dev, "%s: get sysinfo regs..\n", __func__); in cyttsp4_startup_()
1646 rc = cyttsp4_get_sysinfo_regs(cd); in cyttsp4_startup_()
1648 dev_err(cd->dev, "%s: failed to get sysinfo regs rc=%d\n", in cyttsp4_startup_()
1655 rc = cyttsp4_set_mode(cd, CY_MODE_OPERATIONAL); in cyttsp4_startup_()
1657 dev_err(cd->dev, "%s: failed to set mode to operational rc=%d\n", in cyttsp4_startup_()
1664 cyttsp4_lift_all(&cd->md); in cyttsp4_startup_()
1667 mutex_lock(&cd->system_lock); in cyttsp4_startup_()
1668 if (cd->sleep_state == SS_SLEEP_ON) { in cyttsp4_startup_()
1669 cd->sleep_state = SS_SLEEP_OFF; in cyttsp4_startup_()
1670 mutex_unlock(&cd->system_lock); in cyttsp4_startup_()
1671 cyttsp4_core_sleep_(cd); in cyttsp4_startup_()
1674 mutex_unlock(&cd->system_lock); in cyttsp4_startup_()
1677 cyttsp4_start_wd_timer(cd); in cyttsp4_startup_()
1682 static int cyttsp4_startup(struct cyttsp4 *cd) in cyttsp4_startup() argument
1686 mutex_lock(&cd->system_lock); in cyttsp4_startup()
1687 cd->startup_state = STARTUP_RUNNING; in cyttsp4_startup()
1688 mutex_unlock(&cd->system_lock); in cyttsp4_startup()
1690 rc = cyttsp4_request_exclusive(cd, cd->dev, in cyttsp4_startup()
1693 dev_err(cd->dev, "%s: fail get exclusive ex=%p own=%p\n", in cyttsp4_startup()
1694 __func__, cd->exclusive_dev, cd->dev); in cyttsp4_startup()
1698 rc = cyttsp4_startup_(cd); in cyttsp4_startup()
1700 if (cyttsp4_release_exclusive(cd, cd->dev) < 0) in cyttsp4_startup()
1702 dev_err(cd->dev, "%s: fail to release exclusive\n", __func__); in cyttsp4_startup()
1704 dev_vdbg(cd->dev, "%s: pass release exclusive\n", __func__); in cyttsp4_startup()
1707 mutex_lock(&cd->system_lock); in cyttsp4_startup()
1708 cd->startup_state = STARTUP_NONE; in cyttsp4_startup()
1709 mutex_unlock(&cd->system_lock); in cyttsp4_startup()
1712 wake_up(&cd->wait_q); in cyttsp4_startup()
1719 struct cyttsp4 *cd = container_of(work, struct cyttsp4, startup_work); in cyttsp4_startup_work_function() local
1722 rc = cyttsp4_startup(cd); in cyttsp4_startup_work_function()
1724 dev_err(cd->dev, "%s: Fail queued startup r=%d\n", in cyttsp4_startup_work_function()
1728 static void cyttsp4_free_si_ptrs(struct cyttsp4 *cd) in cyttsp4_free_si_ptrs() argument
1730 struct cyttsp4_sysinfo *si = &cd->sysinfo; in cyttsp4_free_si_ptrs()
1747 static int cyttsp4_core_sleep(struct cyttsp4 *cd) in cyttsp4_core_sleep() argument
1751 rc = cyttsp4_request_exclusive(cd, cd->dev, in cyttsp4_core_sleep()
1754 dev_err(cd->dev, "%s: fail get exclusive ex=%p own=%p\n", in cyttsp4_core_sleep()
1755 __func__, cd->exclusive_dev, cd->dev); in cyttsp4_core_sleep()
1759 rc = cyttsp4_core_sleep_(cd); in cyttsp4_core_sleep()
1761 if (cyttsp4_release_exclusive(cd, cd->dev) < 0) in cyttsp4_core_sleep()
1762 dev_err(cd->dev, "%s: fail to release exclusive\n", __func__); in cyttsp4_core_sleep()
1764 dev_vdbg(cd->dev, "%s: pass release exclusive\n", __func__); in cyttsp4_core_sleep()
1769 static int cyttsp4_core_wake_(struct cyttsp4 *cd) in cyttsp4_core_wake_() argument
1771 struct device *dev = cd->dev; in cyttsp4_core_wake_()
1777 mutex_lock(&cd->system_lock); in cyttsp4_core_wake_()
1778 if (cd->sleep_state == SS_SLEEP_OFF) { in cyttsp4_core_wake_()
1779 mutex_unlock(&cd->system_lock); in cyttsp4_core_wake_()
1782 cd->int_status &= ~CY_INT_IGNORE; in cyttsp4_core_wake_()
1783 cd->int_status |= CY_INT_AWAKE; in cyttsp4_core_wake_()
1784 cd->sleep_state = SS_WAKING; in cyttsp4_core_wake_()
1786 if (cd->cpdata->power) { in cyttsp4_core_wake_()
1788 rc = cd->cpdata->power(cd->cpdata, 1, dev, &cd->ignore_irq); in cyttsp4_core_wake_()
1798 cyttsp4_adap_read(cd, CY_REG_BASE, sizeof(mode), &mode); in cyttsp4_core_wake_()
1800 dev_vdbg(cd->dev, "%s: HW power up succeeds\n", in cyttsp4_core_wake_()
1802 mutex_unlock(&cd->system_lock); in cyttsp4_core_wake_()
1804 t = wait_event_timeout(cd->wait_q, in cyttsp4_core_wake_()
1805 (cd->int_status & CY_INT_AWAKE) == 0, in cyttsp4_core_wake_()
1809 mutex_lock(&cd->system_lock); in cyttsp4_core_wake_()
1810 cd->int_status &= ~CY_INT_AWAKE; in cyttsp4_core_wake_()
1812 cyttsp4_queue_startup_(cd); in cyttsp4_core_wake_()
1813 mutex_unlock(&cd->system_lock); in cyttsp4_core_wake_()
1816 mutex_lock(&cd->system_lock); in cyttsp4_core_wake_()
1817 cd->sleep_state = SS_SLEEP_OFF; in cyttsp4_core_wake_()
1818 mutex_unlock(&cd->system_lock); in cyttsp4_core_wake_()
1820 cyttsp4_start_wd_timer(cd); in cyttsp4_core_wake_()
1825 static int cyttsp4_core_wake(struct cyttsp4 *cd) in cyttsp4_core_wake() argument
1829 rc = cyttsp4_request_exclusive(cd, cd->dev, in cyttsp4_core_wake()
1832 dev_err(cd->dev, "%s: fail get exclusive ex=%p own=%p\n", in cyttsp4_core_wake()
1833 __func__, cd->exclusive_dev, cd->dev); in cyttsp4_core_wake()
1837 rc = cyttsp4_core_wake_(cd); in cyttsp4_core_wake()
1839 if (cyttsp4_release_exclusive(cd, cd->dev) < 0) in cyttsp4_core_wake()
1840 dev_err(cd->dev, "%s: fail to release exclusive\n", __func__); in cyttsp4_core_wake()
1842 dev_vdbg(cd->dev, "%s: pass release exclusive\n", __func__); in cyttsp4_core_wake()
1849 struct cyttsp4 *cd = dev_get_drvdata(dev); in cyttsp4_core_suspend() local
1850 struct cyttsp4_mt_data *md = &cd->md; in cyttsp4_core_suspend()
1855 rc = cyttsp4_core_sleep(cd); in cyttsp4_core_suspend()
1865 struct cyttsp4 *cd = dev_get_drvdata(dev); in cyttsp4_core_resume() local
1866 struct cyttsp4_mt_data *md = &cd->md; in cyttsp4_core_resume()
1871 rc = cyttsp4_core_wake(cd); in cyttsp4_core_resume()
1899 static int cyttsp4_setup_input_device(struct cyttsp4 *cd) in cyttsp4_setup_input_device() argument
1901 struct device *dev = cd->dev; in cyttsp4_setup_input_device()
1902 struct cyttsp4_mt_data *md = &cd->md; in cyttsp4_setup_input_device()
1970 static int cyttsp4_mt_probe(struct cyttsp4 *cd) in cyttsp4_mt_probe() argument
1972 struct device *dev = cd->dev; in cyttsp4_mt_probe()
1973 struct cyttsp4_mt_data *md = &cd->md; in cyttsp4_mt_probe()
1974 struct cyttsp4_mt_platform_data *pdata = cd->pdata->mt_pdata; in cyttsp4_mt_probe()
1993 md->input->id.bustype = cd->bus_ops->bustype; in cyttsp4_mt_probe()
2000 md->si = &cd->sysinfo; in cyttsp4_mt_probe()
2002 rc = cyttsp4_setup_input_device(cd); in cyttsp4_mt_probe()
2018 struct cyttsp4 *cd; in cyttsp4_probe() local
2029 cd = kzalloc(sizeof(*cd), GFP_KERNEL); in cyttsp4_probe()
2030 if (!cd) { in cyttsp4_probe()
2036 cd->xfer_buf = kzalloc(xfer_buf_size, GFP_KERNEL); in cyttsp4_probe()
2037 if (!cd->xfer_buf) { in cyttsp4_probe()
2044 cd->dev = dev; in cyttsp4_probe()
2045 cd->pdata = pdata; in cyttsp4_probe()
2046 cd->cpdata = pdata->core_pdata; in cyttsp4_probe()
2047 cd->bus_ops = ops; in cyttsp4_probe()
2050 mutex_init(&cd->system_lock); in cyttsp4_probe()
2051 mutex_init(&cd->adap_lock); in cyttsp4_probe()
2054 init_waitqueue_head(&cd->wait_q); in cyttsp4_probe()
2057 INIT_WORK(&cd->startup_work, cyttsp4_startup_work_function); in cyttsp4_probe()
2058 INIT_WORK(&cd->watchdog_work, cyttsp4_watchdog_work); in cyttsp4_probe()
2061 cd->irq = gpio_to_irq(cd->cpdata->irq_gpio); in cyttsp4_probe()
2062 if (cd->irq < 0) { in cyttsp4_probe()
2067 dev_set_drvdata(dev, cd); in cyttsp4_probe()
2070 if (cd->cpdata->init) { in cyttsp4_probe()
2071 dev_dbg(cd->dev, "%s: Init HW\n", __func__); in cyttsp4_probe()
2072 rc = cd->cpdata->init(cd->cpdata, 1, cd->dev); in cyttsp4_probe()
2074 dev_dbg(cd->dev, "%s: No HW INIT function\n", __func__); in cyttsp4_probe()
2078 dev_err(cd->dev, "%s: HW Init fail r=%d\n", __func__, rc); in cyttsp4_probe()
2080 dev_dbg(dev, "%s: initialize threaded irq=%d\n", __func__, cd->irq); in cyttsp4_probe()
2081 if (cd->cpdata->level_irq_udelay > 0) in cyttsp4_probe()
2088 rc = request_threaded_irq(cd->irq, NULL, cyttsp4_irq, irq_flags, in cyttsp4_probe()
2089 dev_name(dev), cd); in cyttsp4_probe()
2096 timer_setup(&cd->watchdog_timer, cyttsp4_watchdog_timer, 0); in cyttsp4_probe()
2102 rc = cyttsp4_startup(cd); in cyttsp4_probe()
2105 if (rc < 0 && cd->mode == CY_MODE_UNKNOWN) { in cyttsp4_probe()
2106 dev_err(cd->dev, "%s: Fail initial startup r=%d\n", in cyttsp4_probe()
2111 rc = cyttsp4_mt_probe(cd); in cyttsp4_probe()
2119 return cd; in cyttsp4_probe()
2122 cancel_work_sync(&cd->startup_work); in cyttsp4_probe()
2123 cyttsp4_stop_wd_timer(cd); in cyttsp4_probe()
2125 cyttsp4_free_si_ptrs(cd); in cyttsp4_probe()
2126 free_irq(cd->irq, cd); in cyttsp4_probe()
2128 if (cd->cpdata->init) in cyttsp4_probe()
2129 cd->cpdata->init(cd->cpdata, 0, dev); in cyttsp4_probe()
2131 kfree(cd->xfer_buf); in cyttsp4_probe()
2133 kfree(cd); in cyttsp4_probe()
2147 int cyttsp4_remove(struct cyttsp4 *cd) in cyttsp4_remove() argument
2149 struct device *dev = cd->dev; in cyttsp4_remove()
2151 cyttsp4_mt_release(&cd->md); in cyttsp4_remove()
2160 cancel_work_sync(&cd->startup_work); in cyttsp4_remove()
2162 cyttsp4_stop_wd_timer(cd); in cyttsp4_remove()
2164 free_irq(cd->irq, cd); in cyttsp4_remove()
2165 if (cd->cpdata->init) in cyttsp4_remove()
2166 cd->cpdata->init(cd->cpdata, 0, dev); in cyttsp4_remove()
2167 cyttsp4_free_si_ptrs(cd); in cyttsp4_remove()
2168 kfree(cd); in cyttsp4_remove()