soc/oplus/radio: import

From PJD110_14.0.0.810

drivers/soc/oplus/radio/BUILD.bazel

@@ -0,0 +1,9 @@
+package(
+    default_visibility = [
+        "//visibility:public",
+    ],
+)
+
+load(":oplus_local_modules.bzl", "define_oplus_local_modules")
+
+define_oplus_local_modules()

drivers/soc/oplus/radio/mdmfeature/Kconfig

@@ -0,0 +1,7 @@
+# SPDX-License-Identifier: GPL-2.0-only
+# Copyright (C) 2018-2020 Oplus. All rights reserved.
+config OPLUS_FEATURE_MDMFEATURE
+  tristate "config modify modem feature"
+  default n
+  help
+    define this config to modify modem feature.

drivers/soc/oplus/radio/mdmfeature/Makefile

@@ -0,0 +1,3 @@
+# SPDX-License-Identifier: GPL-2.0-only
+# Copyright (C) 2018-2020 Oplus. All rights reserved.
+obj-$(CONFIG_OPLUS_FEATURE_MDMFEATURE) +=  oplus_mdmfeature.o

drivers/soc/oplus/radio/mdmfeature/oplus_mdmfeature.c

@@ -0,0 +1,306 @@
+//#ifdef OPLUS_FEATURE_MDMFEATURE
+/*==============================================================================
+
+ Copyright (c) 2020-2024 OPLUS,  All Rights  Reserved.  OPLUS Proprietary.
+
+-------------------------------------------------------------------------------
+
+                      EDIT HISTORY FOR FILE
+
+  This section contains comments describing changes made to the module.
+  Notice that changes are listed in reverse chronological order.
+
+ when       who     what, where, why
+ --------   ---     ---------------------------------------------------------
+ 2021-10-19   ZhengXueqian  create this module
+
+==============================================================================*/
+#include <linux/init.h>
+#include <linux/module.h>
+#include <linux/miscdevice.h>
+#ifdef CONFIG_ARM
+#include <linux/sched.h>
+#else
+#include <linux/wait.h>
+#endif
+#include <linux/fs.h>
+#include <linux/uaccess.h>
+#include <linux/poll.h>
+#ifdef CONFIG_OPLUS_SYSTEM_KERNEL_QCOM
+#include <linux/soc/qcom/smem.h>
+#endif
+#include <linux/proc_fs.h>
+#include <linux/version.h>
+#if IS_MODULE(CONFIG_OPLUS_FEATURE_SIMCARDNUM)
+#include <oplus_mdmfeature.h>
+#endif
+#include <linux/mutex.h>
+/*****xueqian.zheng ******/
+#define OPLUS_RESERVE1_BLOCK_SZ             (4096)
+#define SMEM_OPLUS_FEATURE_MAP_SZ           (OPLUS_RESERVE1_BLOCK_SZ * 3)
+#define SMEM_OPLUS_FEATURE_MAP 126
+static wait_queue_head_t mdmfeature_wq;
+static int mdmfeature_flag = 0;
+static char mdmfeature_buf[SMEM_OPLUS_FEATURE_MAP_SZ] = {0};
+static DEFINE_MUTEX(g_mutex);
+/*this write interface just use for test*/
+static bool write_mdmfeature_to_smem(char __user * buf, size_t count)
+{
+    size_t smem_size;
+    void *smem_addr;
+    /*get mdmfeature info from smem*/
+    #ifdef CONFIG_OPLUS_SYSTEM_KERNEL_QCOM
+    smem_addr = qcom_smem_get(QCOM_SMEM_HOST_ANY,
+    SMEM_OPLUS_FEATURE_MAP,
+    &smem_size);
+    #endif
+    if (IS_ERR_OR_NULL(smem_addr)) {
+        pr_debug("%s: get mdmfeature failure\n", __func__);
+        return false;
+    }
+    memcpy(smem_addr, buf, count);
+    return true;
+}
+
+static bool read_mdmfeature_from_smem(char __user * buf, size_t* smem_size)
+{
+    void *smem_addr;
+    /*get mdmfeature info from smem*/
+    #ifdef CONFIG_OPLUS_SYSTEM_KERNEL_QCOM
+    smem_addr = qcom_smem_get(QCOM_SMEM_HOST_ANY,
+    SMEM_OPLUS_FEATURE_MAP,
+    smem_size);
+    #endif
+    if (IS_ERR_OR_NULL(smem_addr)) {
+        pr_debug("%s: get mdmfeature failure\n", __func__);
+        return false;
+    }
+    memcpy(buf, smem_addr, *smem_size);
+    return true;
+}
+
+static ssize_t mdmfeature_write(struct file *file, const char __user * buf,
+                size_t count, loff_t * ppos)
+{
+        /*just for test*/
+        if (count > SMEM_OPLUS_FEATURE_MAP_SZ) {
+                return -EFAULT;
+        }
+
+        if (count > *ppos) {
+                count -= *ppos;
+        }
+        else
+                count = 0;
+
+        printk("mdmfeature_write is called\n");
+
+        if (copy_from_user(mdmfeature_buf, buf, count)) {
+                return -EFAULT;
+        }
+        if (!write_mdmfeature_to_smem(mdmfeature_buf, count)) {
+                return -EFAULT;
+        }
+        *ppos += count;
+
+        mdmfeature_flag = 1;
+        wake_up_interruptible(&mdmfeature_wq);
+
+        return count;
+}
+
+
+static unsigned int mdmfeature_poll (struct file *file, struct poll_table_struct *pt)
+{
+        unsigned int ptr = 0;
+
+        poll_wait(file, &mdmfeature_wq, pt);
+
+        if (mdmfeature_flag) {
+                ptr |= POLLIN | POLLRDNORM;
+                mdmfeature_flag = 0;
+        }
+        return ptr;
+}
+
+static int get_mdmfeature_buf_end_index(void)
+{
+        int i = 0;
+        for (i = 0;i < SMEM_OPLUS_FEATURE_MAP_SZ;i++) {
+                if (mdmfeature_buf[i] == '\0') {
+                        break;
+                }
+        }
+        return i;
+}
+
+static ssize_t mdmfeature_read(struct file *file, char __user *buf,
+                size_t count, loff_t *ppos)
+{
+        size_t size = 0;
+
+        if (count > SMEM_OPLUS_FEATURE_MAP_SZ) {
+                return -EFAULT;
+        }
+        if (get_mdmfeature_buf_end_index() == SMEM_OPLUS_FEATURE_MAP_SZ) {
+                return -EFAULT;
+        }
+        size = count < strlen(mdmfeature_buf) ? count : strlen(mdmfeature_buf);
+
+        if (size > *ppos) {
+                size -= *ppos;
+        }
+        else
+                size = 0;
+
+        if (copy_to_user(buf, mdmfeature_buf, size)) {
+                return -EFAULT;
+        }
+        if (!read_mdmfeature_from_smem(mdmfeature_buf, &size)) {
+                return -EFAULT;
+        }
+        /*mdmfeature_flag = 0;*/
+        *ppos += size;
+
+        return size;
+}
+
+static int mdmfeature_release (struct inode *inode, struct file *file)
+{
+        /*mdmfeature_flag = 0;*/
+        /*memset(mdmfeature_buf, 0, SMEM_OPLUS_FEATURE_MAP_SZ);*/
+        return 0;
+}
+
+#define MDMFEATURE_UPDATE_MAGIC 'M'
+#define MDMFEATURE_UPDATE_DSDS _IOWR(MDMFEATURE_UPDATE_MAGIC, 0, int)
+#define MDMFEATURE_UPDATE_SSSS _IOWR(MDMFEATURE_UPDATE_MAGIC, 1, int)
+
+struct proc_dir_entry *manifest_parent = NULL;
+
+static void update_manifest(unsigned int update_type)
+{
+    static const char* telephony_manifest_src[2] = {
+        "/vendor/odm/etc/vintf/network_manifest_ssss.xml",
+        "/vendor/odm/etc/vintf/network_manifest_dsds.xml",
+    };
+
+#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 12, 0))
+    mm_segment_t fs;
+#endif
+    static struct proc_dir_entry *telephony_manifest_ssss = NULL;
+    static struct proc_dir_entry *telephony_manifest_dsds = NULL;
+    printk("update_manifest update_type %d\n", update_type - MDMFEATURE_UPDATE_DSDS);
+#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 12, 0))
+    fs = get_fs();
+    set_fs(KERNEL_DS);
+#endif
+
+    if (manifest_parent) {
+        mutex_lock(&g_mutex);
+        if (telephony_manifest_ssss) {
+            proc_remove(telephony_manifest_ssss);
+            telephony_manifest_ssss = NULL;
+        }
+        if (telephony_manifest_dsds) {
+            proc_remove(telephony_manifest_dsds);
+            telephony_manifest_dsds = NULL;
+        }
+
+        if (update_type == MDMFEATURE_UPDATE_SSSS) {
+            telephony_manifest_ssss = proc_symlink("network_manifest", manifest_parent, telephony_manifest_src[0]);
+        } else {
+            telephony_manifest_dsds = proc_symlink("network_manifest", manifest_parent, telephony_manifest_src[1]);
+        }
+        mutex_unlock(&g_mutex);
+    }
+
+#if (LINUX_VERSION_CODE < KERNEL_VERSION(5, 12, 0))
+    set_fs(fs);
+#endif
+    printk("update_manifest update_type %d done\n", update_type - MDMFEATURE_UPDATE_DSDS);
+}
+
+
+static long mdmfeature_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
+{
+    long ret = 0;
+
+    printk("mdmfeature_ioctl cmd %d\n", cmd - MDMFEATURE_UPDATE_DSDS);
+
+    switch (cmd) {
+        case MDMFEATURE_UPDATE_SSSS:
+        case MDMFEATURE_UPDATE_DSDS:
+            update_manifest(cmd);
+        break;
+        default:
+            ret = -EINVAL;
+    }
+    return ret;
+}
+
+
+static const struct file_operations mdmfeature_device_fops = {
+        .owner  = THIS_MODULE,
+        .read   = mdmfeature_read,
+        .write        = mdmfeature_write,
+        .poll        = mdmfeature_poll,
+        .llseek = generic_file_llseek,
+        .release = mdmfeature_release,
+        .unlocked_ioctl = mdmfeature_ioctl,
+};
+
+static struct miscdevice mdmfeature_device = {
+        MISC_DYNAMIC_MINOR, "mdmfeature", &mdmfeature_device_fops
+};
+
+void mdmfeature_init_smem(void)
+{
+        int ret;
+
+        ret = qcom_smem_alloc(QCOM_SMEM_HOST_ANY, SMEM_OPLUS_FEATURE_MAP,
+                SMEM_OPLUS_FEATURE_MAP_SZ);
+
+        if (ret < 0 && ret != -EEXIST) {
+                pr_err("%s:unable to allocate dp_info \n", __func__);
+                return;
+        }
+}
+
+static int __init mdmfeature_init(void)
+{
+        int ret = -1;
+        mdmfeature_init_smem();
+        manifest_parent = proc_mkdir("oplusManifest", NULL);
+        if (!manifest_parent) {
+            return -1;
+        }
+#if IS_MODULE(CONFIG_OPLUS_FEATURE_SIMCARDNUM)
+        if (sim_card_num[0] == '0') {
+                update_manifest(MDMFEATURE_UPDATE_SSSS);
+        } else {
+                update_manifest(MDMFEATURE_UPDATE_DSDS);
+        }
+#else
+        update_manifest(MDMFEATURE_UPDATE_DSDS);
+#endif
+        init_waitqueue_head(&mdmfeature_wq);
+        ret = misc_register(&mdmfeature_device);
+        if (ret < 0) {
+                proc_remove(manifest_parent);
+        }
+        printk("mdmfeature_init ret = %d done\n", ret);
+        return ret;
+}
+
+static void __exit mdmfeature_exit(void)
+{
+        proc_remove(manifest_parent);
+        misc_deregister(&mdmfeature_device);
+}
+
+module_init(mdmfeature_init);
+module_exit(mdmfeature_exit);
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("Oplus");
+//#endif /*OPLUS_FEATURE_MDMFEATURE*/

drivers/soc/oplus/radio/mdmfeature/oplus_mdmfeature.h

@@ -0,0 +1 @@
+extern char sim_card_num[];

drivers/soc/oplus/radio/mdmrst/Kconfig

@@ -0,0 +1,6 @@
+# SPDX-License-Identifier: GPL-2.0-only
+# Copyright (C) 2018-2020 Oplus. All rights reserved.
+config OPLUS_FEATURE_RECORD_MDMRST
+tristate "config record mdmrst"
+help
+    define this config to count the modem restart times.

drivers/soc/oplus/radio/mdmrst/Makefile

@@ -0,0 +1,3 @@
+# SPDX-License-Identifier: GPL-2.0-only
+# Copyright (C) 2018-2020 Oplus. All rights reserved.
+obj-$(CONFIG_OPLUS_FEATURE_RECORD_MDMRST)	+=  oplus_mdmrst.o