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)
325 lines
7.9 KiB
C
325 lines
7.9 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.
|
|
*/
|
|
|
|
#include <linux/init.h>
|
|
#include <linux/module.h>
|
|
#include <linux/proc_fs.h>
|
|
#include <linux/seq_file.h>
|
|
#include <linux/uaccess.h>
|
|
#include <linux/fs.h> /* needed by file_operations* */
|
|
#include <linux/miscdevice.h> /* needed by miscdevice* */
|
|
#include <linux/sysfs.h>
|
|
#include <linux/device.h> /* needed by device_* */
|
|
#include <linux/fs.h> /* needed by file_operations* */
|
|
#include <mt-plat/sync_write.h>
|
|
#include <scp_helper.h>
|
|
#include <scp_ipi.h>
|
|
#include <linux/delay.h>
|
|
#include "scp_helper.h"
|
|
#include "scp_excep.h"
|
|
|
|
MODULE_LICENSE("GPL");
|
|
|
|
struct met_trace_info_t {
|
|
uint32_t MARKER1;
|
|
uint32_t MARKER2;
|
|
uint32_t trace_data_start;
|
|
uint32_t trace_data_end;
|
|
uint32_t cpu_id;
|
|
uint32_t configuration;
|
|
};
|
|
|
|
static met_trace_info_t met_trace_info[SCP_CORE_TOTAL];
|
|
|
|
unsigned int scp_trace_run_flag;
|
|
unsigned int scp_trace_run_command;
|
|
unsigned int trace_data_selected_id;
|
|
unsigned int trace_r_pos[SCP_CORE_TOTAL] = {0, 0};
|
|
unsigned int sram_offset[SCP_CORE_TOTAL] = {0, 0};
|
|
static void scp_met_handler(int id, void *data, unsigned int len)
|
|
{
|
|
struct met_trace_info_t *tmp = (met_trace_info_t *)data;
|
|
|
|
memcpy((void *)&met_trace_info[tmp->cpu_id], data
|
|
, sizeof(met_trace_info_t));
|
|
pr_notice("[scp_trace] cpu_id:0x%x start addr:0x%x end addr:0x%x\n"
|
|
, tmp->cpu_id
|
|
, met_trace_info[tmp->cpu_id].trace_data_start
|
|
, met_trace_info[tmp->cpu_id].trace_data_end);
|
|
}
|
|
|
|
static ssize_t scp_trace_run_show(struct device *dev
|
|
, struct device_attribute *attr, char *buf)
|
|
{
|
|
int sz;
|
|
|
|
mutex_lock(&dev->mutex);
|
|
sz = snprintf(buf, PAGE_SIZE, "%d\n", scp_trace_run_flag);
|
|
mutex_unlock(&dev->mutex);
|
|
return sz;
|
|
}
|
|
|
|
#define MET_OP_START 0x00000001
|
|
#define MET_OP_STOP 0x00000002
|
|
#define MET_OP_EXTRACT 0x00000003
|
|
#define FUNC_BIT_SHIF 18
|
|
#define MET_OP (1 << FUNC_BIT_SHIF)
|
|
|
|
static ssize_t scp_trace_run_store(struct device *dev
|
|
, struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
int prev_run_state;
|
|
unsigned int value;
|
|
int ret;
|
|
|
|
mutex_lock(&dev->mutex);
|
|
|
|
prev_run_state = scp_trace_run_flag;
|
|
|
|
if (kstrtoint(buf, 10, &scp_trace_run_flag) != 0)
|
|
return -EINVAL;
|
|
|
|
pr_notice("[scp_trace] status:%d\n", scp_trace_run_flag);
|
|
if (prev_run_state == 0 && scp_trace_run_flag == 1) {
|
|
value = MET_OP|MET_OP_START;
|
|
if (scp_trace_run_command & (1<<SCP_A_ID))
|
|
ret = scp_ipi_send(IPI_MET_SCP,
|
|
&value, sizeof(value), 0, SCP_A_ID);
|
|
udelay(1000);
|
|
|
|
trace_r_pos[SCP_A_ID] = 0;
|
|
sram_offset[SCP_A_ID] = 0;
|
|
|
|
} else if (prev_run_state == 1 && scp_trace_run_flag == 0) {
|
|
if (scp_trace_run_command & (1<<SCP_A_ID)) {
|
|
value = MET_OP|MET_OP_STOP;
|
|
ret = scp_ipi_send(IPI_MET_SCP,
|
|
&value, sizeof(value), 0, SCP_A_ID);
|
|
udelay(1000);
|
|
value = MET_OP|MET_OP_EXTRACT;
|
|
ret = scp_ipi_send(IPI_MET_SCP,
|
|
&value, sizeof(value), 0, SCP_A_ID);
|
|
}
|
|
udelay(1000);
|
|
}
|
|
|
|
mutex_unlock(&dev->mutex);
|
|
|
|
return count;
|
|
}
|
|
|
|
static DEVICE_ATTR(scp_trace_run, 0660, scp_trace_run_show,
|
|
scp_trace_run_store);
|
|
static ssize_t scp_trace_setup_show(struct device *dev
|
|
, struct device_attribute *attr, char *buf)
|
|
{
|
|
int sz;
|
|
|
|
mutex_lock(&dev->mutex);
|
|
sz = snprintf(buf, PAGE_SIZE, "%d\n", scp_trace_run_command);
|
|
mutex_unlock(&dev->mutex);
|
|
return sz;
|
|
}
|
|
static ssize_t scp_trace_setup_store(struct device *dev
|
|
, struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
int prev_run_state;
|
|
|
|
mutex_lock(&dev->mutex);
|
|
|
|
prev_run_state = scp_trace_run_command;
|
|
|
|
if (kstrtoint(buf, 10, &scp_trace_run_command) != 0)
|
|
return -EINVAL;
|
|
|
|
pr_notice("[scp_trace] command:%d\n", scp_trace_run_command);
|
|
|
|
mutex_unlock(&dev->mutex);
|
|
|
|
return count;
|
|
}
|
|
static DEVICE_ATTR(scp_trace_setup, 0660,
|
|
scp_trace_setup_show, scp_trace_setup_store);
|
|
|
|
static ssize_t scp_trace_select_show(struct device *dev
|
|
, struct device_attribute *attr, char *buf)
|
|
{
|
|
int sz;
|
|
|
|
mutex_lock(&dev->mutex);
|
|
sz = snprintf(buf, PAGE_SIZE, "%d\n", trace_data_selected_id);
|
|
mutex_unlock(&dev->mutex);
|
|
return sz;
|
|
}
|
|
static ssize_t scp_trace_select_store(struct device *dev
|
|
, struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
int prev_run_state;
|
|
|
|
mutex_lock(&dev->mutex);
|
|
|
|
prev_run_state = trace_data_selected_id;
|
|
|
|
if (kstrtoint(buf, 10, &trace_data_selected_id) != 0)
|
|
return -EINVAL;
|
|
|
|
pr_notice("[scp_trace] trace_data_selected_id:%d\n"
|
|
, trace_data_selected_id);
|
|
|
|
mutex_unlock(&dev->mutex);
|
|
|
|
return count;
|
|
}
|
|
static DEVICE_ATTR(scp_trace_select, 0660, scp_trace_select_show
|
|
, scp_trace_select_store);
|
|
|
|
ssize_t scp_trace_read(char __user *data, size_t len)
|
|
{
|
|
char *buf;
|
|
unsigned int *scp_base;
|
|
unsigned int lock;
|
|
unsigned int *reg;
|
|
|
|
|
|
pr_notice("[scp_trace] selected id:%d\n", trace_data_selected_id);
|
|
reg = (unsigned int *) (scpreg.cfg + SCP_LOCK_OFS);
|
|
lock = *reg;
|
|
*reg &= ~SCP_TCM_LOCK_BIT;
|
|
dsb(SY);
|
|
if ((*reg & SCP_TCM_LOCK_BIT)) {
|
|
pr_debug("[SCP]unlock failed, skip dump\n");
|
|
return 0;
|
|
}
|
|
|
|
buf = ((char *) SCP_TCM)
|
|
+ met_trace_info[trace_data_selected_id].trace_data_start
|
|
+ sram_offset[trace_data_selected_id];
|
|
|
|
len = met_trace_info[trace_data_selected_id].trace_data_end
|
|
- met_trace_info[trace_data_selected_id].trace_data_start
|
|
- trace_r_pos[trace_data_selected_id];
|
|
|
|
pr_notice("[scp_trace] len:%d\n", (int) len);
|
|
scp_base = (unsigned int *) buf;
|
|
/*SCP keep awake */
|
|
scp_awake_lock(trace_data_selected_id);
|
|
/*memory copy from log buf*/
|
|
memcpy_from_scp(data, scp_base, len);
|
|
/*SCP leaave awake */
|
|
scp_awake_unlock(trace_data_selected_id);
|
|
|
|
trace_r_pos[trace_data_selected_id] = 0x4000;
|
|
|
|
return len;
|
|
|
|
}
|
|
|
|
static ssize_t scp_trace_if_read(struct file *file
|
|
, char __user *data, size_t len, loff_t *ppos)
|
|
{
|
|
ssize_t ret;
|
|
#if 0
|
|
unsigned int *buff;
|
|
int i;
|
|
#endif
|
|
|
|
|
|
ret = 0;
|
|
|
|
/*if (access_ok(VERIFY_WRITE, data, len))*/
|
|
ret = scp_trace_read(data, len);
|
|
#if 0
|
|
buff = (unsigned int *)data;
|
|
for (i = 0; i < 0x1000; i++)
|
|
pr_notice("0x%x\n", buff[i]);
|
|
#endif
|
|
|
|
return ret;
|
|
}
|
|
|
|
static ssize_t scp_trace_if_write(struct file *file
|
|
, const char __user *data, size_t len, loff_t *ppos)
|
|
{
|
|
ssize_t ret;
|
|
|
|
ret = 0;
|
|
if (kstrtoint(data, 10, &trace_data_selected_id) != 0)
|
|
return -EINVAL;
|
|
|
|
pr_notice("[scp_trace] selected id:%d\n", trace_data_selected_id);
|
|
|
|
return ret;
|
|
}
|
|
static int scp_trace_if_open(struct inode *inode, struct file *file)
|
|
{
|
|
/*pr_debug("[SCP A] scp_A_log_if_open\n");*/
|
|
return nonseekable_open(inode, file);
|
|
}
|
|
|
|
const struct file_operations scp_trace_ops = {
|
|
.owner = THIS_MODULE,
|
|
.read = scp_trace_if_read,
|
|
.write = scp_trace_if_write,
|
|
.open = scp_trace_if_open,
|
|
};
|
|
|
|
static struct miscdevice scp_trace_device = {
|
|
.minor = MISC_DYNAMIC_MINOR,
|
|
.name = "scp_trace",
|
|
.fops = &scp_trace_ops
|
|
};
|
|
|
|
static int __init init_scp_trace(void)
|
|
{
|
|
int ret;
|
|
|
|
ret = misc_register(&scp_trace_device);
|
|
if (unlikely(ret != 0)) {
|
|
pr_err("[SCP] misc register failed\n");
|
|
return ret;
|
|
}
|
|
|
|
ret = device_create_file(scp_trace_device.this_device,
|
|
&dev_attr_scp_trace_run);
|
|
if (unlikely(ret != 0)) {
|
|
pr_err("[SCP] misc register failed\n");
|
|
return ret;
|
|
}
|
|
|
|
ret = device_create_file(scp_trace_device.this_device,
|
|
&dev_attr_scp_trace_setup);
|
|
if (unlikely(ret != 0)) {
|
|
pr_err("[SCP] misc register failed\n");
|
|
return ret;
|
|
}
|
|
|
|
ret = device_create_file(scp_trace_device.this_device,
|
|
&dev_attr_scp_trace_select);
|
|
if (unlikely(ret != 0)) {
|
|
pr_err("[SCP] misc register failed\n");
|
|
return ret;
|
|
}
|
|
|
|
|
|
scp_ipi_registration(IPI_MET_SCP, scp_met_handler, "met scp trace");
|
|
return 0;
|
|
}
|
|
|
|
static void __exit exit_scp_trace(void)
|
|
{
|
|
}
|
|
|
|
module_init(init_scp_trace);
|
|
module_exit(exit_scp_trace);
|
|
|