178 lines
4.0 KiB
C
178 lines
4.0 KiB
C
/* SPDX-License-Identifier: GPL-2.0 */
|
|
#include <linux/module.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/init.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/proc_fs.h>
|
|
#include <linux/uaccess.h>
|
|
#include <linux/ioport.h>
|
|
#include <linux/param.h>
|
|
#include <linux/bitops.h>
|
|
#include <linux/gpio.h>
|
|
#include <linux/seq_file.h>
|
|
#include <linux/version.h>
|
|
#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 9, 0)
|
|
//#include "include/wakelock.h"
|
|
#include <linux/wakelock.h>
|
|
#else
|
|
#include <linux/wakelock.h>
|
|
#endif
|
|
#include <linux/export.h>
|
|
#include <marlin_platform.h>
|
|
|
|
#include "include/lpm.h"
|
|
|
|
#define VERSION "marlin2 V0.1"
|
|
#define PROC_DIR "bluetooth/sleep"
|
|
|
|
#ifndef FALSE
|
|
#define FALSE 0
|
|
#endif
|
|
#ifndef TRUE
|
|
#define TRUE 1
|
|
#endif
|
|
|
|
struct proc_dir_entry *bluetooth_dir, *sleep_dir;
|
|
static struct wake_lock tx_wakelock;
|
|
static struct wake_lock rx_wakelock;
|
|
|
|
|
|
void host_wakeup_bt(void)
|
|
{
|
|
wake_lock(&tx_wakelock);
|
|
marlin_set_sleep(MARLIN_BLUETOOTH, FALSE);
|
|
marlin_set_wakeup(MARLIN_BLUETOOTH);
|
|
}
|
|
|
|
void bt_wakeup_host(void)
|
|
{
|
|
wake_unlock(&tx_wakelock);
|
|
wake_lock_timeout(&rx_wakelock, HZ * 5);
|
|
|
|
|
|
}
|
|
|
|
static ssize_t bluesleep_write_proc_btwrite(struct file *file,
|
|
const char __user *buffer, size_t count, loff_t *pos)
|
|
{
|
|
char b;
|
|
|
|
if (count < 1)
|
|
{
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (copy_from_user(&b, buffer, 1))
|
|
{
|
|
return -EFAULT;
|
|
}
|
|
|
|
pr_info("bluesleep_write_proc_btwrite=%d", b);
|
|
|
|
if (b == '1')
|
|
{
|
|
host_wakeup_bt();
|
|
}
|
|
else if (b == '2')
|
|
{
|
|
marlin_set_sleep(MARLIN_BLUETOOTH, TRUE);
|
|
wake_unlock(&tx_wakelock);
|
|
}
|
|
else
|
|
{
|
|
pr_err("bludroid pass a unsupport parameter");
|
|
}
|
|
|
|
return count;
|
|
}
|
|
|
|
static int btwrite_proc_show(struct seq_file *m, void *v)
|
|
{
|
|
/*unsigned int btwrite;*/
|
|
pr_info("bluesleep_read_proc_lpm\n");
|
|
seq_puts(m, "unsupported to read\n");
|
|
return 0;
|
|
}
|
|
|
|
static int bluesleep_open_proc_btwrite(struct inode *inode, struct file *file)
|
|
{
|
|
return single_open(file, btwrite_proc_show, PDE_DATA(inode));
|
|
|
|
}
|
|
|
|
static const struct file_operations lpm_proc_btwrite_fops =
|
|
{
|
|
.owner = THIS_MODULE,
|
|
.open = bluesleep_open_proc_btwrite,
|
|
.read = seq_read,
|
|
.write = bluesleep_write_proc_btwrite,
|
|
.release = single_release,
|
|
};
|
|
|
|
/*static int __init bluesleep_init(void)*/
|
|
int bluesleep_init(void)
|
|
{
|
|
int retval;
|
|
struct proc_dir_entry *ent;
|
|
|
|
bluetooth_dir = proc_mkdir("bluetooth", NULL);
|
|
|
|
if (bluetooth_dir == NULL)
|
|
{
|
|
pr_info("Unable to create /proc/bluetooth directory");
|
|
remove_proc_entry("bluetooth", 0);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
sleep_dir = proc_mkdir("sleep", bluetooth_dir);
|
|
|
|
if (sleep_dir == NULL)
|
|
{
|
|
pr_info("Unable to create /proc/%s directory", PROC_DIR);
|
|
remove_proc_entry("bluetooth", 0);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
/* Creating read/write entry */
|
|
ent = proc_create("btwrite", S_IRUGO | S_IWUSR | S_IWGRP, sleep_dir,
|
|
&lpm_proc_btwrite_fops); /*read/write */
|
|
|
|
if (ent == NULL)
|
|
{
|
|
pr_info("Unable to create /proc/%s/btwake entry",
|
|
PROC_DIR);
|
|
retval = -ENOMEM;
|
|
goto fail;
|
|
}
|
|
|
|
wake_lock_init(&tx_wakelock, WAKE_LOCK_SUSPEND, "BT_TX_wakelock");
|
|
wake_lock_init(&rx_wakelock, WAKE_LOCK_SUSPEND, "BT_RX_wakelock");
|
|
return 0;
|
|
|
|
fail:
|
|
remove_proc_entry("btwrite", sleep_dir);
|
|
remove_proc_entry("sleep", bluetooth_dir);
|
|
remove_proc_entry("bluetooth", 0);
|
|
wake_lock_destroy(&tx_wakelock);
|
|
wake_lock_destroy(&rx_wakelock);
|
|
return retval;
|
|
}
|
|
|
|
/*static void __exit bluesleep_exit(void)*/
|
|
void bluesleep_exit(void)
|
|
{
|
|
remove_proc_entry("btwrite", sleep_dir);
|
|
remove_proc_entry("sleep", bluetooth_dir);
|
|
remove_proc_entry("bluetooth", 0);
|
|
wake_lock_destroy(&tx_wakelock);
|
|
wake_lock_destroy(&rx_wakelock);
|
|
|
|
}
|
|
|
|
/*module_init(bluesleep_init);*/
|
|
/*module_exit(bluesleep_exit);*/
|
|
MODULE_DESCRIPTION("Bluetooth Sleep Mode Driver ver %s " VERSION);
|
|
MODULE_LICENSE("GPL");
|
|
|
|
|