BTFM SLIM:Add support for pin connectivity test

Add support for pin connectivity test for BT/FM slimbus

Change-Id: Ia913bcb204f6cccc59790b9a4cef20cbd346f05c
Signed-off-by: Satish Kumar Kodishala <quic_skodisha@quicinc.com>
This commit is contained in:
Satish Kumar Kodishala 2021-12-22 13:41:28 +05:30 committed by Gerrit - the friendly Code Review server
parent cb6bfc80a2
commit 5582182dad

View File

@ -12,6 +12,7 @@
#include <linux/debugfs.h>
#include <linux/ratelimit.h>
#include <linux/slab.h>
#include <linux/fs.h>
#include <linux/btpower.h>
#include <sound/pcm.h>
#include <sound/pcm_params.h>
@ -21,8 +22,13 @@
#include "btfm_slim.h"
#include "btfm_slim_slave.h"
#define BT_CMD_SLIM_TEST 0xbfac
#define DELAY_FOR_PORT_OPEN_MS (200)
struct class *btfm_slim_class;
static int btfm_slim_major;
struct btfmslim *btfm_slim_drv_data;
static bool btfm_is_port_opening_delayed = true;
int btfm_slim_write(struct btfmslim *btfmslim,
@ -612,6 +618,25 @@ static int btfm_slim_get_dt_info(struct btfmslim *btfmslim)
return ret;
}
static long btfm_slim_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
{
int ret = 0;
BTFMSLIM_INFO("");
switch (cmd) {
case BT_CMD_SLIM_TEST:
BTFMSLIM_INFO("cmd BT_CMD_SLIM_TEST, call btfm_slim_hw_init");
ret = btfm_slim_hw_init(btfm_slim_drv_data);
break;
}
return ret;
}
static const struct file_operations bt_dev_fops = {
.unlocked_ioctl = btfm_slim_ioctl,
.compat_ioctl = btfm_slim_ioctl,
};
static int btfm_slim_probe(struct slim_device *slim)
{
int ret = 0;
@ -668,7 +693,36 @@ static int btfm_slim_probe(struct slim_device *slim)
btfm_slim_unregister_codec(&slim->dev);
goto free;
}
btfm_slim_drv_data = btfm_slim;
btfm_slim_major = register_chrdev(0, "btfm_slim", &bt_dev_fops);
if (btfm_slim_major < 0) {
BTFMSLIM_ERR("%s: failed to allocate char dev\n", __func__);
ret = -1;
goto register_err;
}
btfm_slim_class = class_create(THIS_MODULE, "btfmslim-dev");
if (IS_ERR(btfm_slim_class)) {
BTFMSLIM_ERR("%s: coudn't create class\n", __func__);
ret = -1;
goto class_err;
}
if (device_create(btfm_slim_class, NULL, MKDEV(btfm_slim_major, 0),
NULL, "btfmslim") == NULL) {
BTFMSLIM_ERR("%s: failed to allocate char dev\n", __func__);
ret = -1;
goto device_err;
}
return ret;
device_err:
class_destroy(btfm_slim_class);
class_err:
unregister_chrdev(btfm_slim_major, "btfm_slim");
register_err:
btfm_slim_unregister_codec(&slim->dev);
free:
slim_remove_device(&btfm_slim->slim_ifd);
dealloc: