threeeye
bc1d038eac
Squashed backup commit (no shallow-clone history issues) of xiaomi-mt6833-dev/kernel_xiaomi_mt6833 (lineage-23.2 branch, upstream commit 9eece662e) plus all fixes applied to get everpal_defconfig building clean against a modern (GCC 15.2.0) toolchain -- see the previous commit message on the lineage-23.2 branch (also in this repo history is not available here since this is a squashed snapshot; full incremental history lives in the local DL380 checkout and the upstream GitHub remote). Upstream: https://github.com/xiaomi-mt6833-dev/kernel_xiaomi_mt6833 (lineage-23.2)
167 lines
4.0 KiB
C
167 lines
4.0 KiB
C
/*
|
|
* Copyright (C) 2016 MediaTek Inc.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* 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 http://www.gnu.org/licenses/gpl-2.0.html for more details.
|
|
*/
|
|
|
|
/* flat sensor driver
|
|
*
|
|
* This software is licensed under the terms of the GNU General Public
|
|
* License version 2, as published by the Free Software Foundation, and
|
|
* may be copied, distributed, and modified under those terms.
|
|
*
|
|
* 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/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 "flat.h"
|
|
#include "situation.h"
|
|
|
|
#include <hwmsen_helper.h>
|
|
|
|
#include <SCP_sensorHub.h>
|
|
#include <linux/notifier.h>
|
|
#include "scp_helper.h"
|
|
|
|
|
|
static int flat_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_FLAT, &data);
|
|
if (err < 0) {
|
|
pr_warn("sensor_get_data_from_hub fail!!\n");
|
|
return -1;
|
|
}
|
|
time_stamp = data.time_stamp;
|
|
*probability = data.gesture_data_t.probability;
|
|
pr_debug("recv ipi: timestamp: %lld, probability: %d!\n", time_stamp,
|
|
*probability);
|
|
return 0;
|
|
}
|
|
|
|
static int flat_open_report_data(int open)
|
|
{
|
|
int ret = 0;
|
|
|
|
pr_debug("%s : enable=%d\n", __func__, open);
|
|
#if defined CONFIG_MTK_SCP_SENSORHUB_V1
|
|
if (open == 1)
|
|
ret = sensor_set_delay_to_hub(ID_FLAT, 120);
|
|
#elif defined CONFIG_NANOHUB
|
|
|
|
#else
|
|
|
|
#endif
|
|
|
|
ret = sensor_enable_to_hub(ID_FLAT, open);
|
|
return ret;
|
|
}
|
|
|
|
static int flat_batch(int flag, int64_t samplingPeriodNs,
|
|
int64_t maxBatchReportLatencyNs)
|
|
{
|
|
pr_debug("%s : flag=%d\n", __func__, flag);
|
|
|
|
return sensor_batch_to_hub(ID_FLAT, flag, samplingPeriodNs,
|
|
maxBatchReportLatencyNs);
|
|
}
|
|
|
|
static int flat_recv_data(struct data_unit_t *event, void *reserved)
|
|
{
|
|
int err = 0;
|
|
|
|
if (event->flush_action == FLUSH_ACTION)
|
|
pr_warn("flat do not support flush\n");
|
|
else if (event->flush_action == DATA_ACTION)
|
|
err = situation_notify_t(ID_FLAT, (int64_t)event->time_stamp);
|
|
return err;
|
|
}
|
|
|
|
static int flat_local_init(void)
|
|
{
|
|
struct situation_control_path ctl = {0};
|
|
struct situation_data_path data = {0};
|
|
int err = 0;
|
|
|
|
ctl.open_report_data = flat_open_report_data;
|
|
ctl.batch = flat_batch;
|
|
ctl.is_support_wake_lock = true;
|
|
err = situation_register_control_path(&ctl, ID_FLAT);
|
|
if (err) {
|
|
pr_warn("register flat control path err\n");
|
|
goto exit;
|
|
}
|
|
|
|
data.get_data = flat_get_data;
|
|
err = situation_register_data_path(&data, ID_FLAT);
|
|
if (err) {
|
|
pr_warn("register flat data path err\n");
|
|
goto exit;
|
|
}
|
|
err = scp_sensorHub_data_registration(ID_FLAT, flat_recv_data);
|
|
if (err) {
|
|
pr_warn("SCP_sensorHub_data_registration fail!!\n");
|
|
goto exit_create_attr_failed;
|
|
}
|
|
return 0;
|
|
exit:
|
|
exit_create_attr_failed:
|
|
return -1;
|
|
}
|
|
static int flat_local_uninit(void)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static struct situation_init_info flat_init_info = {
|
|
.name = "flat_hub",
|
|
.init = flat_local_init,
|
|
.uninit = flat_local_uninit,
|
|
};
|
|
|
|
static int __init flat_init(void)
|
|
{
|
|
situation_driver_add(&flat_init_info, ID_FLAT);
|
|
return 0;
|
|
}
|
|
|
|
static void __exit flat_exit(void)
|
|
{
|
|
pr_debug("flat exit\n");
|
|
}
|
|
|
|
module_init(flat_init);
|
|
module_exit(flat_exit);
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_DESCRIPTION("GLANCE_GESTURE_HUB driver");
|
|
MODULE_AUTHOR("ruixue.su@mediatek.com");
|
|
|