134 lines
3.0 KiB
C
134 lines
3.0 KiB
C
#include <linux/init.h>
|
|
#include <linux/module.h>
|
|
#include <linux/kobject.h>
|
|
#include <linux/sysfs.h>
|
|
#include <linux/string.h>
|
|
#include <linux/mmhardware_others.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_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_HAPTIC_1, haptic1);
|
|
MM_INFO(MM_HW_HAPTIC_2, haptic2);
|
|
MM_INFO(MM_HW_AS, audioswitch);
|
|
|
|
static struct attribute *mm_attrs[] = {
|
|
&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;
|
|
|
|
static int __init mmhardware_others_init(void)
|
|
{
|
|
int err;
|
|
/* create mm_hardware under /sys */
|
|
mm_sysfs_kobj = kobject_create_and_add(MM_HARDWARE_SYSFS_OTHERS_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;
|
|
}
|
|
|
|
static void __exit mmhardware_others_exit(void)
|
|
{
|
|
kobject_put(mm_sysfs_kobj);
|
|
}
|
|
|
|
int register_otherkobj_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_otherkobj_under_mmsysfs);
|
|
|
|
module_init(mmhardware_others_init);
|
|
module_exit(mmhardware_others_exit);
|
|
MODULE_DESCRIPTION("mm module");
|
|
MODULE_LICENSE("GPL v2");
|