android/android_kernel_xiaomi_sm8450
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

misc: Import mmhardware

Browse Source 
Also ran clang-format

Change-Id: Ia7e7f8b9794944ec372423c5645e74a335a4898a
This commit is contained in:
Arian 2023-11-15 18:17:48 +01:00 committed by Jens Reidel
parent e9078b7343
commit 1a57779fa9
No known key found for this signature in database
GPG Key ID: 23C1E5F512C12303
4 changed files with 288 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
drivers/misc/Kconfig
View File

@ -515,6 +515,12 @@ config LDO_WL2866D
This driver provides support for the voltage regulators and top-level
chip enablement of WL2866
config MMHARDWARE_DETECTION
tristate "Register xiaomi mmhardware detection module"
default n
help
This adds support for mmhardware detection
source "drivers/misc/rtimd-i2c/Kconfig"
source "drivers/misc/c2port/Kconfig"
source "drivers/misc/eeprom/Kconfig"

1
drivers/misc/Makefile
View File

@ -70,3 +70,4 @@ obj-$(CONFIG_WIGIG_SENSING_SPI) += wigig_sensing.o
obj-$(CONFIG_KINECTICS_XR_NORDIC) += kxrctrl/
obj-y += hwid/
obj-$(CONFIG_LDO_WL2866D) += wl2866d.o
obj-$(CONFIG_MMHARDWARE_DETECTION) += mmhardware_sysfs.o

217
drivers/misc/mmhardware_sysfs.c Normal file
View File

@ -0,0 +1,217 @@
#include <linux/init.h>
#include <linux/module.h>
#include <linux/kobject.h>
#include <linux/sysfs.h>
#include <linux/string.h>
#include <linux/mmhardware_sysfs.h>
/* show */
static ssize_t mm_register_show(struct kobject *dev, struct kobj_attribute *a,
char *buf)
{
struct mm_info *mi = container_of(a, struct mm_info, k_attr);
switch (mi->mm_id) {
case MM_HW_ADSP:
if (!mi->on_register) {
pr_info("%s: 0x%x is not registered\n", __func__,
mi->mm_id);
}
return sprintf(buf, "%d\n", mi->on_register);
break;
case MM_HW_CODEC:
if (!mi->on_register) {
pr_info("%s: 0x%x is not registered\n", __func__,
mi->mm_id);
}
return sprintf(buf, "%d\n", mi->on_register);
break;
case MM_HW_PA_1:
if (!mi->on_register) {
pr_info("%s: 0x%x is not registered\n", __func__,
mi->mm_id);
}
return sprintf(buf, "%d\n", mi->on_register);
break;
case MM_HW_PA_2:
if (!mi->on_register) {
pr_info("%s: 0x%x is not registered\n", __func__,
mi->mm_id);
}
return sprintf(buf, "%d\n", mi->on_register);
break;
case MM_HW_PA_3:
if (!mi->on_register) {
pr_info("%s: 0x%x is not registered\n", __func__,
mi->mm_id);
}
return sprintf(buf, "%d\n", mi->on_register);
break;
case MM_HW_PA_4:
if (!mi->on_register) {
pr_info("%s: 0x%x is not registered\n", __func__,
mi->mm_id);
}
return sprintf(buf, "%d\n", mi->on_register);
break;
case MM_HW_PA_5:
if (!mi->on_register) {
pr_info("%s: 0x%x is not registered\n", __func__,
mi->mm_id);
}
return sprintf(buf, "%d\n", mi->on_register);
break;
case MM_HW_PA_6:
if (!mi->on_register) {
pr_info("%s: 0x%x is not registered\n", __func__,
mi->mm_id);
}
return sprintf(buf, "%d\n", mi->on_register);
break;
case MM_HW_PA_7:
if (!mi->on_register) {
pr_info("%s: 0x%x is not registered\n", __func__,
mi->mm_id);
}
return sprintf(buf, "%d\n", mi->on_register);
break;
case MM_HW_PA_8:
if (!mi->on_register) {
pr_info("%s: 0x%x is not registered\n", __func__,
mi->mm_id);
}
return sprintf(buf, "%d\n", mi->on_register);
break;
case MM_HW_HAPTIC_1:
if (!mi->on_register) {
pr_info("%s: 0x%x is not registered\n", __func__,
mi->mm_id);
}
return sprintf(buf, "%d\n", mi->on_register);
break;
case MM_HW_HAPTIC_2:
if (!mi->on_register) {
pr_info("%s: 0x%x is not registered\n", __func__,
mi->mm_id);
}
return sprintf(buf, "%d\n", mi->on_register);
break;
case MM_HW_AS:
if (!mi->on_register) {
pr_info("%s: 0x%x is not registered\n", __func__,
mi->mm_id);
}
return sprintf(buf, "%d\n", mi->on_register);
break;
default:
break;
}
return 0;
}
/* store */
static ssize_t mm_register_store(struct kobject *dev, struct kobj_attribute *a,
const char *buf, size_t count)
{
return count;
}
MM_INFO(MM_HW_ADSP, adsp);
MM_INFO(MM_HW_CODEC, codec);
MM_INFO(MM_HW_PA_1, pa1);
MM_INFO(MM_HW_PA_2, pa2);
MM_INFO(MM_HW_PA_3, pa3);
MM_INFO(MM_HW_PA_4, pa4);
MM_INFO(MM_HW_PA_5, pa5);
MM_INFO(MM_HW_PA_6, pa6);
MM_INFO(MM_HW_PA_7, pa7);
MM_INFO(MM_HW_PA_8, pa8);
MM_INFO(MM_HW_HAPTIC_1, haptic1);
MM_INFO(MM_HW_HAPTIC_2, haptic2);
MM_INFO(MM_HW_AS, audioswitch);
static struct attribute *mm_attrs[] = {
&adsp_info.k_attr.attr,
&codec_info.k_attr.attr,
&pa1_info.k_attr.attr,
&pa2_info.k_attr.attr,
&pa3_info.k_attr.attr,
&pa4_info.k_attr.attr,
&pa5_info.k_attr.attr,
&pa6_info.k_attr.attr,
&pa7_info.k_attr.attr,
&pa8_info.k_attr.attr,
&haptic1_info.k_attr.attr,
&haptic2_info.k_attr.attr,
&audioswitch_info.k_attr.attr,
NULL, /* need to NULL terminate the list of attributes */
};
static struct attribute_group mm_attr_group = {
.attrs = mm_attrs,
};
static struct kobject *mm_sysfs_kobj;
int mmhardware_initialize_sysfs(void)
{
int err;
/* create mm_hardware under /sys */
mm_sysfs_kobj = kobject_create_and_add(MM_HARDWARE_SYSFS_ROOT_FOLDER,
kernel_kobj->parent);
if (!mm_sysfs_kobj) {
pr_err("failed to create kobj");
return -ENOMEM;
}
err = sysfs_create_group(mm_sysfs_kobj, &mm_attr_group);
if (err) {
pr_err("failed to create sysfs group");
kobject_put(mm_sysfs_kobj);
return -ENOMEM;
}
return 0;
}
void mmhardware_cleanup_sysfs(void)
{
kobject_put(mm_sysfs_kobj);
}
int register_kobj_under_mmsysfs(enum hardware_id mm_id, const char *name)
{
int ret = 0;
int iter = 0;
int find_id = 0;
struct mm_info *mi = NULL;
struct kobj_attribute *mi_attr = NULL;
struct attribute *a = mm_attrs[iter];
if (name == NULL) {
pr_err("%s: device_name is empty\n", __func__);
ret = -2;
goto err;
}
while (a) {
mi_attr = container_of(a, struct kobj_attribute, attr);
mi = container_of(mi_attr, struct mm_info, k_attr);
iter++;
a = mm_attrs[iter];
if (mm_id == mi->mm_id) {
find_id = 1;
if (mi->on_register) {
pr_info("%s: device(id:%d name:%s) has already registered\n",
__func__, mi->mm_id, name);
ret = -4;
goto err;
}
mi->on_register = 1;
goto err;
} else
continue;
}
if (find_id == 0) {
pr_err("%s: Can't find correct hardware_id: 0x%x\n", __func__,
mm_id);
ret = -3;
}
err:
return ret;
}
EXPORT_SYMBOL(register_kobj_under_mmsysfs);
subsys_initcall(mmhardware_initialize_sysfs);
module_exit(mmhardware_cleanup_sysfs);
MODULE_AUTHOR("xiaomi mm");
MODULE_DESCRIPTION("Multimedia hardware detection");
MODULE_LICENSE("GPL");

64
include/linux/mmhardware_sysfs.h Normal file
View File

@ -0,0 +1,64 @@
#ifndef __MMHARDWARE_SYSFS_H__
#define __MMHARDWARE_SYSFS_H__
#define MM_HARDWARE_SYSFS_ROOT_FOLDER "mm_hardware"
#define MM_HARDWARE_SYSFS_ADSP_FOLDER "adsp"
#define MM_HARDWARE_SYSFS_CODEC_FOLDER "codec"
#define MM_HARDWARE_SYSFS_PA_1_FOLDER "pa1"
#define MM_HARDWARE_SYSFS_PA_2_FOLDER "pa2"
#define MM_HARDWARE_SYSFS_PA_3_FOLDER "pa3"
#define MM_HARDWARE_SYSFS_PA_4_FOLDER "pa4"
#define MM_HARDWARE_SYSFS_PA_5_FOLDER "pa5"
#define MM_HARDWARE_SYSFS_PA_6_FOLDER "pa6"
#define MM_HARDWARE_SYSFS_PA_7_FOLDER "pa7"
#define MM_HARDWARE_SYSFS_PA_8_FOLDER "pa8"
#define MM_HARDWARE_SYSFS_AUDIOSWITCH_FOLDER "audioswitch"
#define MM_HARDWARE_SYSFS_HAPTIC_1_FOLDER "haptic1"
#define MM_HARDWARE_SYSFS_HAPTIC_2_FOLDER "haptic2"
enum hardware_id {
MM_HW_FINE = 0x1,
MM_HW_ADSP = 0x2,
MM_HW_CODEC = 0x4,
MM_HW_PA_1 = 0x8,
MM_HW_PA_2 = 0x10,
MM_HW_PA_3 = 0x20,
MM_HW_PA_4 = 0x40,
MM_HW_PA_5 = 0x80,
MM_HW_PA_6 = 0x100,
MM_HW_PA_7 = 0x200,
MM_HW_PA_8 = 0x400,
MM_HW_AS = 0x800,
MM_HW_HAPTIC_1 = 0x1000,
MM_HW_HAPTIC_2 = 0x2000
};
struct mm_info {
struct kobj_attribute k_attr;
enum hardware_id mm_id;
int on_register;
};
#define __MMHW(_id, _mm_name) \
{ \
.k_attr = { \
.attr = { \
.name = __stringify(_mm_name), \
.mode = 0644, \
}, \
.show = mm_register_show, \
.store = mm_register_store, \
}, \
.mm_id = _id, \
.on_register = 0, \
}
/* create sysfs node */
#define MM_INFO(_id, _mm_name) \
struct mm_info _mm_name##_info = __MMHW(_id, _mm_name)
int mmhardware_initialize_sysfs(void);
void mmhardware_cleanup_sysfs(void);
int register_kobj_under_mmsysfs(enum hardware_id mm_id, const char *name);
#endif