drivers/input/touchscreen/IST3032B/ist30xx_tracking.c

/*
 *  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 "ist30xx.h"
#include "ist30xx_update.h"
#include "ist30xx_misc.h"
#include "ist30xx_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();

	spin_lock_irqsave(&mr_lock, flags);

	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;
}