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)
157 lines
3.9 KiB
C
157 lines
3.9 KiB
C
/*
|
|
* Copyright (C) 2015 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 the
|
|
* GNU General Public License for more details.
|
|
*/
|
|
|
|
|
|
#define DFT_TAG "[CONN_MD_EXP]"
|
|
#include "conn_md_log.h"
|
|
|
|
#include "conn_md_exp.h"
|
|
|
|
#include "conn_md.h"
|
|
|
|
struct conn_md_bridge_ops g_ops;
|
|
|
|
static int conn_md_test_rx_cb(struct ipc_ilm *ilm);
|
|
|
|
int conn_md_test(void)
|
|
{
|
|
#define PACKAGE_SIZE 100
|
|
|
|
struct ipc_ilm ilm;
|
|
struct local_para *p_buf_str;
|
|
int i = 0;
|
|
int msg_len = 0;
|
|
|
|
p_buf_str = kmalloc(sizeof(struct local_para) + PACKAGE_SIZE,
|
|
GFP_ATOMIC);
|
|
if (p_buf_str == NULL) {
|
|
CONN_MD_ERR_FUNC("kmalloc for local para structure failed.\n");
|
|
return -1;
|
|
}
|
|
p_buf_str->msg_len = PACKAGE_SIZE;
|
|
for (i = 0; i < PACKAGE_SIZE; i++)
|
|
p_buf_str->data[i] = i;
|
|
|
|
ilm.local_para_ptr = p_buf_str;
|
|
|
|
g_ops.rx_cb = conn_md_test_rx_cb;
|
|
|
|
mtk_conn_md_bridge_reg(0x800001, &g_ops);
|
|
mtk_conn_md_bridge_reg(0x800005, &g_ops);
|
|
mtk_conn_md_bridge_reg(0x800009, &g_ops);
|
|
|
|
ilm.dest_mod_id = 0x800005;
|
|
ilm.src_mod_id = 0x800001;
|
|
ilm.msg_id = 0;
|
|
|
|
mtk_conn_md_bridge_send_msg(&ilm);
|
|
|
|
ilm.dest_mod_id = 0x800005;
|
|
ilm.src_mod_id = 0x800009;
|
|
ilm.msg_id++;
|
|
msg_len += 10;
|
|
msg_len = ((msg_len >= PACKAGE_SIZE) ? PACKAGE_SIZE : msg_len);
|
|
ilm.local_para_ptr->msg_len = msg_len;
|
|
mtk_conn_md_bridge_send_msg(&ilm);
|
|
|
|
ilm.dest_mod_id = 0x800001;
|
|
ilm.src_mod_id = 0x800009;
|
|
ilm.msg_id++;
|
|
msg_len += 10;
|
|
msg_len = ((msg_len >= PACKAGE_SIZE) ? PACKAGE_SIZE : msg_len);
|
|
ilm.local_para_ptr->msg_len = msg_len;
|
|
mtk_conn_md_bridge_send_msg(&ilm);
|
|
|
|
ilm.dest_mod_id = 0x80000a;
|
|
ilm.src_mod_id = 0x800009;
|
|
ilm.msg_id++;
|
|
msg_len += 10;
|
|
msg_len = ((msg_len >= PACKAGE_SIZE) ? PACKAGE_SIZE : msg_len);
|
|
ilm.local_para_ptr->msg_len = msg_len;
|
|
mtk_conn_md_bridge_send_msg(&ilm);
|
|
|
|
ilm.dest_mod_id = 0x800009;
|
|
ilm.src_mod_id = 0x80000a;
|
|
ilm.msg_id++;
|
|
msg_len += 10;
|
|
msg_len = ((msg_len >= PACKAGE_SIZE) ? PACKAGE_SIZE : msg_len);
|
|
ilm.local_para_ptr->msg_len = msg_len;
|
|
mtk_conn_md_bridge_send_msg(&ilm);
|
|
|
|
ilm.dest_mod_id = 0x800005;
|
|
ilm.src_mod_id = 0x800001;
|
|
ilm.msg_id++;
|
|
msg_len += 10;
|
|
msg_len = ((msg_len >= PACKAGE_SIZE) ? PACKAGE_SIZE : msg_len);
|
|
ilm.local_para_ptr->msg_len = msg_len;
|
|
mtk_conn_md_bridge_send_msg(&ilm);
|
|
|
|
ilm.dest_mod_id = 0x800001;
|
|
ilm.src_mod_id = 0x800005;
|
|
ilm.msg_id++;
|
|
msg_len += 10;
|
|
msg_len = ((msg_len >= PACKAGE_SIZE) ? PACKAGE_SIZE : msg_len);
|
|
ilm.local_para_ptr->msg_len = msg_len;
|
|
mtk_conn_md_bridge_send_msg(&ilm);
|
|
|
|
ilm.dest_mod_id = 0x800001;
|
|
ilm.src_mod_id = 0x80000a;
|
|
ilm.msg_id++;
|
|
msg_len += 10;
|
|
msg_len = ((msg_len >= PACKAGE_SIZE) ? PACKAGE_SIZE : msg_len);
|
|
ilm.local_para_ptr->msg_len = msg_len;
|
|
mtk_conn_md_bridge_send_msg(&ilm);
|
|
|
|
kfree(p_buf_str);
|
|
p_buf_str = NULL;
|
|
|
|
conn_md_dmp_msg_queued(0, 0x80000a);
|
|
|
|
mtk_conn_md_bridge_unreg(0x800001);
|
|
conn_md_dmp_msg_queued(0, 0);
|
|
conn_md_dmp_msg_active(0, 0);
|
|
|
|
mtk_conn_md_bridge_unreg(0x800009);
|
|
|
|
mtk_conn_md_bridge_unreg(0x80000a);
|
|
conn_md_dmp_msg_queued(0, 0);
|
|
conn_md_dmp_msg_active(0, 0);
|
|
|
|
conn_md_dmp_msg_logged(0x800009, 0x800001);
|
|
conn_md_dmp_msg_logged(0x800009, 0);
|
|
conn_md_dmp_msg_logged(0, 0);
|
|
conn_md_dmp_msg_logged(0x80000a, 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int conn_md_test_rx_cb(struct ipc_ilm *ilm)
|
|
{
|
|
int i = 0;
|
|
|
|
pr_info("%s, ilm:0x%p\n", __func__, ilm);
|
|
pr_info("%s, ilm:src_id(%d), dst_id(%d), msg_id(%d)\n", __func__,
|
|
ilm->src_mod_id, ilm->dest_mod_id, ilm->msg_id);
|
|
|
|
pr_info("%s, local_para_ptr:0x%p, msg_len:%d\n",
|
|
__func__, ilm->local_para_ptr,
|
|
ilm->local_para_ptr->msg_len);
|
|
|
|
for (i = 0; i < ilm->local_para_ptr->msg_len; i++) {
|
|
pr_info("%d ", ilm->local_para_ptr->data[i]);
|
|
if ((i != 0) && (((1 + i) % 8) == 0))
|
|
pr_info("\n");
|
|
}
|
|
return 0;
|
|
}
|