126 lines
3 KiB
C
126 lines
3 KiB
C
|
/*
|
||
|
|
* Copyright (C) 2018, Samsung Electronics 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 "../sensorhub/shub_device.h"
|
||
|
|
#include "../comm/shub_iio.h"
|
||
|
|
#include "../sensormanager/shub_sensor_type.h"
|
||
|
|
#include "../utility/shub_utility.h"
|
||
|
|
#include "../vendor/shub_vendor.h"
|
||
|
|
|
||
|
|
#include <linux/fs.h>
|
||
|
|
#include <linux/io.h>
|
||
|
|
#include <linux/mm.h>
|
||
|
|
#include <linux/slab.h>
|
||
|
|
#include <linux/uaccess.h>
|
||
|
|
|
||
|
|
#define SENSORHUB_DUMP_NOTI_EVENT 0xFC
|
||
|
|
|
||
|
|
char *sensorhub_dump;
|
||
|
|
int sensorhub_dump_size;
|
||
|
|
|
||
|
|
static ssize_t shub_dump_read(struct file *file, struct kobject *kobj, struct bin_attribute *battr, char *buf,
|
||
|
|
loff_t off, size_t size)
|
||
|
|
{
|
||
|
|
memcpy_fromio(buf, battr->private + off, size);
|
||
|
|
return size;
|
||
|
|
}
|
||
|
|
|
||
|
|
BIN_ATTR_RO(shub_dump, 0);
|
||
|
|
|
||
|
|
struct bin_attribute *shub_dump_bin_attrs[] = {
|
||
|
|
&bin_attr_shub_dump,
|
||
|
|
};
|
||
|
|
|
||
|
|
static int create_dump_bin_file(void)
|
||
|
|
{
|
||
|
|
int ret;
|
||
|
|
uint64_t i;
|
||
|
|
struct shub_data_t *data = get_shub_data();
|
||
|
|
|
||
|
|
shub_infof();
|
||
|
|
|
||
|
|
sensorhub_dump = kvzalloc(sensorhub_dump_size, GFP_KERNEL);
|
||
|
|
if (ZERO_OR_NULL_PTR(sensorhub_dump)) {
|
||
|
|
shub_infof("fail to alloc memory");
|
||
|
|
return -EINVAL;
|
||
|
|
}
|
||
|
|
|
||
|
|
shub_infof("dump size %d", sensorhub_dump_size);
|
||
|
|
|
||
|
|
bin_attr_shub_dump.size = sensorhub_dump_size;
|
||
|
|
bin_attr_shub_dump.private = sensorhub_dump;
|
||
|
|
|
||
|
|
for (i = 0; i < ARRAY_SIZE(shub_dump_bin_attrs); i++) {
|
||
|
|
struct bin_attribute *battr = shub_dump_bin_attrs[i];
|
||
|
|
|
||
|
|
ret = device_create_bin_file(data->sysfs_dev, battr);
|
||
|
|
if (ret < 0) {
|
||
|
|
shub_errf("Failed to create file: %s %d", battr->attr.name, ret);
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
if (ret < 0) {
|
||
|
|
kvfree(sensorhub_dump);
|
||
|
|
sensorhub_dump = NULL;
|
||
|
|
sensorhub_dump_size = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
void write_shub_dump_file(char *dump, int dumpsize, int type, int count)
|
||
|
|
{
|
||
|
|
char buffer[3];
|
||
|
|
|
||
|
|
if (!dump) {
|
||
|
|
shub_errf("dump is NULL");
|
||
|
|
return;
|
||
|
|
} else if (dumpsize != sensorhub_dump_size) {
|
||
|
|
shub_errf("dump size is wrong %d(%d)", dumpsize, sensorhub_dump_size);
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
memcpy_fromio(sensorhub_dump, dump, sensorhub_dump_size);
|
||
|
|
|
||
|
|
shub_infof("%d %d", type, count);
|
||
|
|
|
||
|
|
buffer[0] = SENSORHUB_DUMP_NOTI_EVENT;
|
||
|
|
buffer[1] = type;
|
||
|
|
buffer[2] = count;
|
||
|
|
shub_report_sensordata(SENSOR_TYPE_SENSORHUB, get_current_timestamp(), buffer, sizeof(buffer));
|
||
|
|
}
|
||
|
|
|
||
|
|
void initialize_shub_dump(void)
|
||
|
|
{
|
||
|
|
shub_infof();
|
||
|
|
|
||
|
|
sensorhub_dump_size = sensorhub_get_dump_size();
|
||
|
|
create_dump_bin_file();
|
||
|
|
}
|
||
|
|
|
||
|
|
void remove_shub_dump(void)
|
||
|
|
{
|
||
|
|
uint64_t i;
|
||
|
|
struct shub_data_t *data = get_shub_data();
|
||
|
|
|
||
|
|
if (ZERO_OR_NULL_PTR(sensorhub_dump))
|
||
|
|
return;
|
||
|
|
|
||
|
|
kvfree(sensorhub_dump);
|
||
|
|
for (i = 0; i < ARRAY_SIZE(shub_dump_bin_attrs); i++)
|
||
|
|
device_remove_bin_file(data->sysfs_dev, shub_dump_bin_attrs[i]);
|
||
|
|
}
|