diff options
| author | Yuval Adam <_@yuv.al> | 2017-08-30 08:25:59 +0000 |
|---|---|---|
| committer | Yuval Adam <_@yuv.al> | 2017-08-30 08:25:59 +0000 |
| commit | 8e4bff4cab0ddac6060645b0715210484d02ff40 (patch) | |
| tree | 3a5c3024371a04692a3a6d9974d001cdff8ebf84 /drivers/input/touchscreen/ist30xxb/ist30xxb_tracking.c | |
Diffstat (limited to 'drivers/input/touchscreen/ist30xxb/ist30xxb_tracking.c')
| -rwxr-xr-x | drivers/input/touchscreen/ist30xxb/ist30xxb_tracking.c | 205 |
1 files changed, 205 insertions, 0 deletions
diff --git a/drivers/input/touchscreen/ist30xxb/ist30xxb_tracking.c b/drivers/input/touchscreen/ist30xxb/ist30xxb_tracking.c new file mode 100755 index 00000000..706e4cb7 --- /dev/null +++ b/drivers/input/touchscreen/ist30xxb/ist30xxb_tracking.c @@ -0,0 +1,205 @@ +/*
+ * Copyright (C) 2010,Imagis Technology Co. Ltd. All Rights Reserved.
+ *
+ * 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, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ */
+
+#include <linux/i2c.h>
+#include <linux/delay.h>
+#include <linux/slab.h>
+#include <linux/spinlock.h>
+#include <linux/stat.h>
+
+#include <linux/input/ist30xxb.h>
+#include "ist30xxb_update.h"
+#include "ist30xxb_misc.h"
+#include "ist30xxb_tracking.h"
+
+#define S_IRWXUGO 0644
+
+IST30XX_RING_BUF TrackBuf;
+IST30XX_RING_BUF *pTrackBuf;
+
+void ist30xx_tracking_init(void)
+{
+ pTrackBuf = &TrackBuf;
+
+ pTrackBuf->RingBufCtr = 0;
+ pTrackBuf->RingBufInIdx = 0;
+ pTrackBuf->RingBufOutIdx = 0;
+}
+
+void ist30xx_tracking_deinit(void)
+{
+}
+
+int ist30xx_get_track(u32 *ms, u32 *status)
+{
+ unsigned long flags;
+ //spinlock_t mr_lock = SPIN_LOCK_UNLOCKED;
+ spinlock_t mr_lock = __SPIN_LOCK_UNLOCKED();
+
+ if (!pTrackBuf->RingBufCtr)
+ return IST30XX_RINGBUF_EMPTY;
+
+ spin_lock_irqsave(&mr_lock, flags);
+
+ if (pTrackBuf->RingBufOutIdx == IST30XX_RINGBUF_SIZE)
+ pTrackBuf->RingBufOutIdx = 0;
+ *ms = pTrackBuf->TimeBuf[pTrackBuf->RingBufOutIdx];
+ *status = pTrackBuf->StatusBuf[pTrackBuf->RingBufOutIdx];
+
+ pTrackBuf->RingBufOutIdx++;
+ pTrackBuf->RingBufCtr--;
+
+ spin_unlock_irqrestore(&mr_lock, flags);
+
+ return IST30XX_RINGBUF_NO_ERR;
+}
+
+int ist30xx_get_track_cnt(void)
+{
+ return pTrackBuf->RingBufCtr;
+}
+
+#if IST30XX_TRACKING_MODE
+int ist30xx_put_track(u32 ms, u32 status)
+{
+ unsigned long flags;
+ //spinlock_t mr_lock = SPIN_LOCK_UNLOCKED;
+ spinlock_t mr_lock = __SPIN_LOCK_UNLOCKED();
+ #if PRINT_TSP_LOG
+ printk("[TSP] %s : %d\n", __func__, __LINE__);
+ #endif
+ //spin_lock_irqsave(&mr_lock, flags);
+ return 0;
+ pTrackBuf->RingBufCtr++;
+
+ if (pTrackBuf->RingBufCtr > IST30XX_RINGBUF_SIZE) {
+ pTrackBuf->RingBufCtr = IST30XX_RINGBUF_SIZE;
+ pTrackBuf->RingBufOutIdx++;
+ }
+ if (pTrackBuf->RingBufInIdx == IST30XX_RINGBUF_SIZE)
+ pTrackBuf->RingBufInIdx = 0;
+ if (pTrackBuf->RingBufOutIdx == IST30XX_RINGBUF_SIZE)
+ pTrackBuf->RingBufOutIdx = 0;
+ pTrackBuf->TimeBuf[pTrackBuf->RingBufInIdx] = ms;
+ pTrackBuf->StatusBuf[pTrackBuf->RingBufInIdx] = status;
+ pTrackBuf->RingBufInIdx++;
+ //spin_unlock_irqrestore(&mr_lock, flags);
+
+ return IST30XX_RINGBUF_NO_ERR;
+}
+
+static struct timespec t_track;
+int ist30xx_tracking(u32 status)
+{
+ u32 ms;
+
+ ktime_get_ts(&t_track);
+ ms = t_track.tv_sec * 1000 + t_track.tv_nsec / 1000000;
+
+ return ist30xx_put_track(ms, status);
+}
+#else
+int ist30xx_put_track(u32 ms, u32 status)
+{
+ return 0;
+}
+int ist30xx_tracking(u32 status)
+{
+ return 0;
+}
+#endif // IST30XX_TRACKING_MODE
+
+#define MAX_TRACKING_COUNT (300)
+struct timespec t_curr; // ns
+
+/* sysfs: /sys/class/touch/tracking/track_frame */
+ssize_t ist30xx_track_frame_show(struct device *dev, struct device_attribute *attr,
+ char *buf)
+{
+ int i, buf_cnt = 0;
+ int track_cnt = MAX_TRACKING_COUNT;
+ u32 *buf32 = (u32 *)buf;
+ u32 ms = 0, status = 0;
+ finger_info *finger = (finger_info *)&status;
+
+ mutex_lock(&ist30xx_mutex);
+
+ buf[0] = '\0';
+
+ if (track_cnt > ist30xx_get_track_cnt())
+ track_cnt = ist30xx_get_track_cnt();
+
+ tsp_verb("num: %d of %d\n", track_cnt, ist30xx_get_track_cnt());
+
+ for (i = 0; i < track_cnt; i++) {
+ ist30xx_get_track(&ms, &status);
+ finger = (finger_info *)&status;
+
+ tsp_verb("%08X: %08x\n", ms, status);
+ *buf32++ = ms;
+ *buf32++ = status;
+
+ buf_cnt += (sizeof(u32) * 2);
+ }
+
+ mutex_unlock(&ist30xx_mutex);
+
+ return buf_cnt;
+}
+
+/* sysfs: /sys/class/touch/tracking/track_cnt */
+ssize_t ist30xx_track_cnt_show(struct device *dev, struct device_attribute *attr,
+ char *buf)
+{
+ u32 *buf32 = (u32 *)buf;
+
+ *buf32 = (u32)ist30xx_get_track_cnt();
+
+ tsp_verb("cnt: %d\n", *buf32);
+
+ return sizeof(u32);
+}
+
+
+/* sysfs */
+static DEVICE_ATTR(track_frame, S_IRWXUGO, ist30xx_track_frame_show, NULL);
+static DEVICE_ATTR(track_cnt, S_IRWXUGO, ist30xx_track_cnt_show, NULL);
+
+static struct attribute *tracking_attributes[] = {
+ &dev_attr_track_frame.attr,
+ &dev_attr_track_cnt.attr,
+ NULL,
+};
+
+static struct attribute_group tracking_attr_group = {
+ .attrs = tracking_attributes,
+};
+
+extern struct class *ist30xx_class;
+struct device *ist30xx_tracking_dev;
+
+int ist30xx_init_tracking_sysfs(void)
+{
+ /* /sys/class/touch/tracking */
+ ist30xx_tracking_dev = device_create(ist30xx_class, NULL, 0, NULL, "tracking");
+
+ /* /sys/class/touch/tracking/... */
+ if (sysfs_create_group(&ist30xx_tracking_dev->kobj, &tracking_attr_group))
+ tsp_err("[ TSP ] Failed to create sysfs group(%s)!\n", "tracking");
+
+ ist30xx_tracking_init();
+
+ return 0;
+}
|