unplugged-kernel/drivers/misc/mediatek/sensors-1.0/situation/inpocket/inpocket.c

// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (c) 2019 MediaTek Inc.
 */

#define pr_fmt(fmt) "[inpocket] " fmt

#include <linux/interrupt.h>
#include <linux/i2c.h>
#include <linux/slab.h>
#include <linux/irq.h>
#include <linux/miscdevice.h>
#include <linux/uaccess.h>
#include <linux/delay.h>
#include <linux/input.h>
#include <linux/workqueue.h>
#include <linux/kobject.h>
#include <linux/platform_device.h>
#include <linux/atomic.h>

#include <hwmsensor.h>
#include <sensors_io.h>
#include "inpocket.h"
#include "situation.h"

#include <hwmsen_helper.h>

#include <SCP_sensorHub.h>
#include <linux/notifier.h>
#include "include/scp.h"

static struct situation_init_info inpocket_init_info;

static int inpocket_get_data(int *probability, int *status)
{
	int err = 0;
	struct data_unit_t data;
	uint64_t time_stamp = 0;

	err = sensor_get_data_from_hub(ID_IN_POCKET, &data);
	if (err < 0) {
		pr_err("sensor_get_data_from_hub fail!!\n");
		return -1;
	}
	time_stamp		= data.time_stamp;
	*probability	= data.gesture_data_t.probability;
	return 0;
}
static int inpocket_open_report_data(int open)
{
	int ret = 0;

#if defined CONFIG_MTK_SCP_SENSORHUB_V1
	if (open == 1)
		ret = sensor_set_delay_to_hub(ID_IN_POCKET, 120);
#elif defined CONFIG_NANOHUB

#else

#endif
	pr_debug("%s : type=%d, open=%d\n", __func__, ID_IN_POCKET, open);
	ret = sensor_enable_to_hub(ID_IN_POCKET, open);
	return ret;
}
static int inpocket_batch(int flag,
	int64_t samplingPeriodNs, int64_t maxBatchReportLatencyNs)
{
	return sensor_batch_to_hub(ID_IN_POCKET,
		flag, samplingPeriodNs, maxBatchReportLatencyNs);
}
static int inpocket_recv_data(struct data_unit_t *event, void *reserved)
{
	int err = 0;

	if (event->flush_action == FLUSH_ACTION)
		pr_debug("inpocket do not support flush\n");
	else if (event->flush_action == DATA_ACTION)
		err = situation_notify_t(ID_IN_POCKET,
				(int64_t)event->time_stamp);
	return err;
}

static int inpocket_local_init(void)
{
	struct situation_control_path ctl = {0};
	struct situation_data_path data = {0};
	int err = 0;

	pr_debug("%s\n", __func__);

	ctl.open_report_data = inpocket_open_report_data;
	ctl.batch = inpocket_batch;
	ctl.is_support_wake_lock = true;
	err = situation_register_control_path(&ctl, ID_IN_POCKET);
	if (err) {
		pr_err("register in_pocket control path err\n");
		goto exit;
	}

	data.get_data = inpocket_get_data;
	err = situation_register_data_path(&data, ID_IN_POCKET);
	if (err) {
		pr_err("register in_pocket data path err\n");
		goto exit;
	}
	err = scp_sensorHub_data_registration(ID_IN_POCKET, inpocket_recv_data);
	if (err) {
		pr_err("SCP_sensorHub_data_registration fail!!\n");
		goto exit_create_attr_failed;
	}
	return 0;
exit:
exit_create_attr_failed:
	return -1;
}
static int inpocket_local_uninit(void)
{
	return 0;
}

static struct situation_init_info inpocket_init_info = {
	.name = "in_pocket_hub",
	.init = inpocket_local_init,
	.uninit = inpocket_local_uninit,
};

static int __init inpocket_init(void)
{
	situation_driver_add(&inpocket_init_info, ID_IN_POCKET);
	return 0;
}

static void __exit inpocket_exit(void)
{
	pr_debug("%s\n", __func__);
}

module_init(inpocket_init);
module_exit(inpocket_exit);
MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("InPocket driver");
MODULE_AUTHOR("qiangming.xia@mediatek.com");