tobi/M7350
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
f9cc65cfda
M7350/kernel/arch/arm/mach-msm/qdsp6v2/ultrasound/usf.c

1481 lines
36 KiB
C
Raw Normal View History

M7350v1_en_gpl
2024-09-09 08:52:07 +00:00
/* Copyright (c) 2011-2013, The Linux Foundation. All rights reserved.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 and
* only version 2 as published by the Free Software Foundation.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
*/
#include <linux/fs.h>
#include <linux/module.h>
#include <linux/miscdevice.h>
#include <linux/sched.h>
#include <linux/slab.h>
#include <linux/wait.h>
#include <linux/input.h>
#include <linux/uaccess.h>
#include <linux/time.h>
#include <asm/mach-types.h>
#include <sound/apr_audio.h>
#include <mach/qdsp6v2/usf.h>
#include "q6usm.h"
#include "usfcdev.h"
/* The driver version*/
#define DRV_VERSION "1.4.2"
#define USF_VERSION_ID 0x0142
/* Standard timeout in the asynchronous ops */
#define USF_TIMEOUT_JIFFIES (1*HZ) /* 1 sec */
/* Undefined USF device */
#define USF_UNDEF_DEV_ID 0xffff
/* RX memory mapping flag */
#define USF_VM_WRITE 2
/* Number of events, copied from the user space to kernel one */
#define USF_EVENTS_PORTION_SIZE 20
/* Indexes in range definitions */
#define MIN_IND 0
#define MAX_IND 1
/* The coordinates indexes */
#define X_IND 0
#define Y_IND 1
#define Z_IND 2
/* Shared memory limits */
/* max_buf_size = (port_size(65535*2) * port_num(8) * group_size(3) */
#define USF_MAX_BUF_SIZE 3145680
#define USF_MAX_BUF_NUM 32
/* Place for opreation result, received from QDSP6 */
#define APR_RESULT_IND 1
/* Place for US detection result, received from QDSP6 */
#define APR_US_DETECT_RESULT_IND 0
/* The driver states */
enum usf_state_type {
USF_IDLE_STATE,
USF_OPENED_STATE,
USF_CONFIGURED_STATE,
USF_WORK_STATE,
USF_ERROR_STATE
};
/* The US detection status upon FW/HW based US detection results */
enum usf_us_detect_type {
USF_US_DETECT_UNDEF,
USF_US_DETECT_YES,
USF_US_DETECT_NO
};
struct usf_xx_type {
/* Name of the client - event calculator */
char client_name[USF_MAX_CLIENT_NAME_SIZE];
/* The driver state in TX or RX direction */
enum usf_state_type usf_state;
/* wait for q6 events mechanism */
wait_queue_head_t wait;
/* IF with q6usm info */
struct us_client *usc;
/* Q6:USM' Encoder/decoder configuration */
struct us_encdec_cfg encdec_cfg;
/* Shared buffer (with Q6:USM) size */
uint32_t buffer_size;
/* Number of the shared buffers (with Q6:USM) */
uint32_t buffer_count;
/* Shared memory (Cyclic buffer with 1 gap) control */
uint32_t new_region;
uint32_t prev_region;
/* Q6:USM's events handler */
void (*cb)(uint32_t, uint32_t, uint32_t *, void *);
/* US detection result */
enum usf_us_detect_type us_detect_type;
/* User's update info isn't acceptable */
u8 user_upd_info_na;
};
struct usf_type {
/* TX device component configuration & control */
struct usf_xx_type usf_tx;
/* RX device component configuration & control */
struct usf_xx_type usf_rx;
/* Index into the opened device container */
/* To prevent mutual usage of the same device */
uint16_t dev_ind;
/* Event types, supported by device */
uint16_t event_types;
/* The input devices are "input" module registered clients */
struct input_dev *input_ifs[USF_MAX_EVENT_IND];
/* The event source */
int event_src;
/* Bitmap of types of events, conflicting to USF's ones */
uint16_t conflicting_event_types;
/* Bitmap of types of events from devs, conflicting with USF */
uint16_t conflicting_event_filters;
};
struct usf_input_dev_type {
/* Input event type, supported by the input device */
uint16_t event_type;
/* Input device name */
const char *input_dev_name;
/* Input device registration function */
int (*prepare_dev)(uint16_t, struct usf_type *,
struct us_input_info_type *,
const char *);
/* Input event notification function */
void (*notify_event)(struct usf_type *,
uint16_t,
struct usf_event_type *
);
};
/* The MAX number of the supported devices */
#define MAX_DEVS_NUMBER 1
/* The opened devices container */
static const int s_event_src_map[] = {
BTN_TOOL_PEN, /* US_INPUT_SRC_PEN*/
0, /* US_INPUT_SRC_FINGER */
0, /* US_INPUT_SRC_UNDEF */
};
/* The opened devices container */
static int s_opened_devs[MAX_DEVS_NUMBER];
#define USF_NAME_PREFIX "usf_"
#define USF_NAME_PREFIX_SIZE 4
static struct input_dev *allocate_dev(uint16_t ind, const char *name)
{
struct input_dev *in_dev = input_allocate_device();
if (in_dev == NULL) {
pr_err("%s: input_allocate_device() failed\n", __func__);
} else {
/* Common part configuration */
in_dev->name = name;
in_dev->phys = NULL;
in_dev->id.bustype = BUS_HOST;
in_dev->id.vendor = 0x0001;
in_dev->id.product = 0x0001;
in_dev->id.version = USF_VERSION_ID;
}
return in_dev;
}
static int prepare_tsc_input_device(uint16_t ind,
struct usf_type *usf_info,
struct us_input_info_type *input_info,
const char *name)
{
struct input_dev *in_dev = allocate_dev(ind, name);
if (in_dev == NULL)
return -ENOMEM;
usf_info->input_ifs[ind] = in_dev;
in_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS);
in_dev->keybit[BIT_WORD(BTN_TOUCH)] = BIT_MASK(BTN_TOUCH);
input_set_abs_params(in_dev, ABS_X,
input_info->tsc_x_dim[MIN_IND],
input_info->tsc_x_dim[MAX_IND],
0, 0);
input_set_abs_params(in_dev, ABS_Y,
input_info->tsc_y_dim[MIN_IND],
input_info->tsc_y_dim[MAX_IND],
0, 0);
input_set_abs_params(in_dev, ABS_DISTANCE,
input_info->tsc_z_dim[MIN_IND],
input_info->tsc_z_dim[MAX_IND],
0, 0);
input_set_abs_params(in_dev, ABS_PRESSURE,
input_info->tsc_pressure[MIN_IND],
input_info->tsc_pressure[MAX_IND],
0, 0);
input_set_abs_params(in_dev, ABS_TILT_X,
input_info->tsc_x_tilt[MIN_IND],
input_info->tsc_x_tilt[MAX_IND],
0, 0);
input_set_abs_params(in_dev, ABS_TILT_Y,
input_info->tsc_y_tilt[MIN_IND],
input_info->tsc_y_tilt[MAX_IND],
0, 0);
return 0;
}
static int prepare_mouse_input_device(uint16_t ind, struct usf_type *usf_info,
struct us_input_info_type *input_info,
const char *name)
{
struct input_dev *in_dev = allocate_dev(ind, name);
if (in_dev == NULL)
return -ENOMEM;
usf_info->input_ifs[ind] = in_dev;
in_dev->evbit[0] |= BIT_MASK(EV_KEY) | BIT_MASK(EV_REL);
in_dev->keybit[BIT_WORD(BTN_MOUSE)] = BIT_MASK(BTN_LEFT) |
BIT_MASK(BTN_RIGHT) |
BIT_MASK(BTN_MIDDLE);
in_dev->relbit[0] = BIT_MASK(REL_X) |
BIT_MASK(REL_Y) |
BIT_MASK(REL_Z);
return 0;
}
static int prepare_keyboard_input_device(
uint16_t ind,
struct usf_type *usf_info,
struct us_input_info_type *input_info,
const char *name)
{
struct input_dev *in_dev = allocate_dev(ind, name);
if (in_dev == NULL)
return -ENOMEM;
usf_info->input_ifs[ind] = in_dev;
in_dev->evbit[0] |= BIT_MASK(EV_KEY);
/* All keys are permitted */
memset(in_dev->keybit, 0xff, sizeof(in_dev->keybit));
return 0;
}
static void notify_tsc_event(struct usf_type *usf_info,
uint16_t if_ind,
struct usf_event_type *event)
{
struct input_dev *input_if = usf_info->input_ifs[if_ind];
struct point_event_type *pe = &(event->event_data.point_event);
input_report_abs(input_if, ABS_X, pe->coordinates[X_IND]);
input_report_abs(input_if, ABS_Y, pe->coordinates[Y_IND]);
input_report_abs(input_if, ABS_DISTANCE, pe->coordinates[Z_IND]);
input_report_abs(input_if, ABS_TILT_X, pe->inclinations[X_IND]);
input_report_abs(input_if, ABS_TILT_Y, pe->inclinations[Y_IND]);
input_report_abs(input_if, ABS_PRESSURE, pe->pressure);
input_report_key(input_if, BTN_TOUCH, !!(pe->pressure));
if (usf_info->event_src)
input_report_key(input_if, usf_info->event_src, 1);
input_sync(input_if);
pr_debug("%s: TSC event: xyz[%d;%d;%d], incl[%d;%d], pressure[%d]\n",
__func__,
pe->coordinates[X_IND],
pe->coordinates[Y_IND],
pe->coordinates[Z_IND],
pe->inclinations[X_IND],
pe->inclinations[Y_IND],
pe->pressure);
}
static void notify_mouse_event(struct usf_type *usf_info,
uint16_t if_ind,
struct usf_event_type *event)
{
struct input_dev *input_if = usf_info->input_ifs[if_ind];
struct mouse_event_type *me = &(event->event_data.mouse_event);
input_report_rel(input_if, REL_X, me->rels[X_IND]);
input_report_rel(input_if, REL_Y, me->rels[Y_IND]);
input_report_rel(input_if, REL_Z, me->rels[Z_IND]);
input_report_key(input_if, BTN_LEFT,
me->buttons_states & USF_BUTTON_LEFT_MASK);
input_report_key(input_if, BTN_MIDDLE,
me->buttons_states & USF_BUTTON_MIDDLE_MASK);
input_report_key(input_if, BTN_RIGHT,
me->buttons_states & USF_BUTTON_RIGHT_MASK);
input_sync(input_if);
pr_debug("%s: mouse event: dx[%d], dy[%d], buttons_states[%d]\n",
__func__, me->rels[X_IND],
me->rels[Y_IND], me->buttons_states);
}
static void notify_key_event(struct usf_type *usf_info,
uint16_t if_ind,
struct usf_event_type *event)
{
struct input_dev *input_if = usf_info->input_ifs[if_ind];
struct key_event_type *ke = &(event->event_data.key_event);
input_report_key(input_if, ke->key, ke->key_state);
input_sync(input_if);
pr_debug("%s: key event: key[%d], state[%d]\n",
__func__,
ke->key,
ke->key_state);
}
static struct usf_input_dev_type s_usf_input_devs[] = {
{USF_TSC_EVENT, "usf_tsc",
prepare_tsc_input_device, notify_tsc_event},
{USF_TSC_PTR_EVENT, "usf_tsc_ptr",
prepare_tsc_input_device, notify_tsc_event},
{USF_MOUSE_EVENT, "usf_mouse",
prepare_mouse_input_device, notify_mouse_event},
{USF_KEYBOARD_EVENT, "usf_kb",
prepare_keyboard_input_device, notify_key_event},
};
static void usf_rx_cb(uint32_t opcode, uint32_t token,
uint32_t *payload, void *priv)
{
struct usf_xx_type *usf_xx = (struct usf_xx_type *) priv;
if (usf_xx == NULL) {
pr_err("%s: the private data is NULL\n", __func__);
return;
}
switch (opcode) {
case Q6USM_EVENT_WRITE_DONE:
wake_up(&usf_xx->wait);
break;
default:
break;
}
}
static void usf_tx_cb(uint32_t opcode, uint32_t token,
uint32_t *payload, void *priv)
{
struct usf_xx_type *usf_xx = (struct usf_xx_type *) priv;
if (usf_xx == NULL) {
pr_err("%s: the private data is NULL\n", __func__);
return;
}
switch (opcode) {
case Q6USM_EVENT_READ_DONE:
if (token == USM_WRONG_TOKEN)
usf_xx->usf_state = USF_ERROR_STATE;
usf_xx->new_region = token;
wake_up(&usf_xx->wait);
break;
case Q6USM_EVENT_SIGNAL_DETECT_RESULT:
usf_xx->us_detect_type = (payload[APR_US_DETECT_RESULT_IND]) ?
USF_US_DETECT_YES :
USF_US_DETECT_NO;
wake_up(&usf_xx->wait);
break;
case APR_BASIC_RSP_RESULT:
if (payload[APR_RESULT_IND]) {
usf_xx->usf_state = USF_ERROR_STATE;
usf_xx->new_region = USM_WRONG_TOKEN;
wake_up(&usf_xx->wait);
}
break;
default:
break;
}
}
static void release_xx(struct usf_xx_type *usf_xx)
{
if (usf_xx != NULL) {
if (usf_xx->usc) {
q6usm_us_client_free(usf_xx->usc);
usf_xx->usc = NULL;
}
if (usf_xx->encdec_cfg.params != NULL) {
kfree(usf_xx->encdec_cfg.params);
usf_xx->encdec_cfg.params = NULL;
}
}
}
static void usf_disable(struct usf_xx_type *usf_xx)
{
if (usf_xx != NULL) {
if ((usf_xx->usf_state != USF_IDLE_STATE) &&
(usf_xx->usf_state != USF_OPENED_STATE)) {
(void)q6usm_cmd(usf_xx->usc, CMD_CLOSE);
usf_xx->usf_state = USF_OPENED_STATE;
wake_up(&usf_xx->wait);
}
release_xx(usf_xx);
}
}
static int config_xx(struct usf_xx_type *usf_xx, struct us_xx_info_type *config)
{
int rc = 0;
uint16_t data_map_size = 0;
uint16_t min_map_size = 0;
if ((usf_xx == NULL) ||
(config == NULL))
return -EINVAL;
if ((config->buf_size == 0) ||
(config->buf_size > USF_MAX_BUF_SIZE) ||
(config->buf_num == 0) ||
(config->buf_num > USF_MAX_BUF_NUM)) {
pr_err("%s: wrong params: buf_size=%d; buf_num=%d\n",
__func__, config->buf_size, config->buf_num);
return -EINVAL;
}
data_map_size = sizeof(usf_xx->encdec_cfg.cfg_common.data_map);
min_map_size = min(data_map_size, config->port_cnt);
if (config->client_name != NULL) {
if (strncpy_from_user(usf_xx->client_name,
config->client_name,
sizeof(usf_xx->client_name) - 1) < 0) {
pr_err("%s: get client name failed\n", __func__);
return -EINVAL;
}
}
pr_debug("%s: name=%s; buf_size:%d; dev_id:0x%x; sample_rate:%d\n",
__func__, usf_xx->client_name, config->buf_size,
config->dev_id, config->sample_rate);
pr_debug("%s: buf_num:%d; format:%d; port_cnt:%d; data_size=%d\n",
__func__, config->buf_num, config->stream_format,
config->port_cnt, config->params_data_size);
pr_debug("%s: id[0]=%d, id[1]=%d, id[2]=%d, id[3]=%d, id[4]=%d\n",
__func__,
config->port_id[0],
config->port_id[1],
config->port_id[2],
config->port_id[3],
config->port_id[4]);
/* q6usm allocation & configuration */
usf_xx->buffer_size = config->buf_size;
usf_xx->buffer_count = config->buf_num;
usf_xx->encdec_cfg.cfg_common.bits_per_sample =
config->bits_per_sample;
usf_xx->encdec_cfg.cfg_common.sample_rate = config->sample_rate;
/* AFE port e.g. AFE_PORT_ID_SLIMBUS_MULTI_CHAN_1_RX */
usf_xx->encdec_cfg.cfg_common.dev_id = config->dev_id;
usf_xx->encdec_cfg.cfg_common.ch_cfg = config->port_cnt;
memcpy((void *)&usf_xx->encdec_cfg.cfg_common.data_map,
(void *)config->port_id,
min_map_size);
if (rc) {
pr_err("%s: ports offsets copy failure\n", __func__);
return -EINVAL;
}
usf_xx->encdec_cfg.format_id = config->stream_format;
usf_xx->encdec_cfg.params_size = config->params_data_size;
usf_xx->user_upd_info_na = 1; /* it's used in US_GET_TX_UPDATE */
if (config->params_data_size > 0) { /* transparent data copy */
usf_xx->encdec_cfg.params = kzalloc(config->params_data_size,
GFP_KERNEL);
if (usf_xx->encdec_cfg.params == NULL) {
pr_err("%s: params memory alloc[%d] failure\n",
__func__,
config->params_data_size);
return -ENOMEM;
}
rc = copy_from_user(usf_xx->encdec_cfg.params,
config->params_data,
config->params_data_size);
if (rc) {
pr_err("%s: transparent data copy failure\n",
__func__);
kfree(usf_xx->encdec_cfg.params);
usf_xx->encdec_cfg.params = NULL;
return -EFAULT;
}
pr_debug("%s: params_size[%d]; params[%d,%d,%d,%d, %d]\n",
__func__,
config->params_data_size,
usf_xx->encdec_cfg.params[0],
usf_xx->encdec_cfg.params[1],
usf_xx->encdec_cfg.params[2],
usf_xx->encdec_cfg.params[3],
usf_xx->encdec_cfg.params[4]
);
}
usf_xx->usc = q6usm_us_client_alloc(usf_xx->cb, (void *)usf_xx);
if (!usf_xx->usc) {
pr_err("%s: Could not allocate q6usm client\n", __func__);
rc = -EFAULT;
}
return rc;
}
static bool usf_match(uint16_t event_type_ind, struct input_dev *dev)
{
bool rc = false;
rc = (event_type_ind < MAX_EVENT_TYPE_NUM) &&
((dev->name == NULL) ||
strncmp(dev->name, USF_NAME_PREFIX, USF_NAME_PREFIX_SIZE));
pr_debug("%s: name=[%s]; rc=%d\n",
__func__, dev->name, rc);
return rc;
}
static bool usf_register_conflicting_events(uint16_t event_types)
{
bool rc = true;
uint16_t ind = 0;
uint16_t mask = 1;
for (ind = 0; ind < MAX_EVENT_TYPE_NUM; ++ind) {
if (event_types & mask) {
rc = usfcdev_register(ind, usf_match);
if (!rc)
break;
}
mask = mask << 1;
}
return rc;
}
static void usf_unregister_conflicting_events(uint16_t event_types)
{
uint16_t ind = 0;
uint16_t mask = 1;
for (ind = 0; ind < MAX_EVENT_TYPE_NUM; ++ind) {
if (event_types & mask)
usfcdev_unregister(ind);
mask = mask << 1;
}
}
static void usf_set_event_filters(struct usf_type *usf, uint16_t event_filters)
{
uint16_t ind = 0;
uint16_t mask = 1;
if (usf->conflicting_event_filters != event_filters) {
for (ind = 0; ind < MAX_EVENT_TYPE_NUM; ++ind) {
if (usf->conflicting_event_types & mask)
usfcdev_set_filter(ind, event_filters&mask);
mask = mask << 1;
}
usf->conflicting_event_filters = event_filters;
}
}
static int register_input_device(struct usf_type *usf_info,
struct us_input_info_type *input_info)
{
int rc = 0;
bool ret = true;
uint16_t ind = 0;
if ((usf_info == NULL) ||
(input_info == NULL) ||
!(input_info->event_types & USF_ALL_EVENTS)) {
pr_err("%s: wrong input parameter(s)\n", __func__);
return -EINVAL;
}
if (input_info->event_src < ARRAY_SIZE(s_event_src_map))
usf_info->event_src =
s_event_src_map[input_info->event_src];
else
usf_info->event_src = 0;
for (ind = 0; ind < USF_MAX_EVENT_IND; ++ind) {
if (usf_info->input_ifs[ind] != NULL) {
pr_err("%s: input_if[%d] is already allocated\n",
__func__, ind);
return -EFAULT;
}
if ((input_info->event_types &
s_usf_input_devs[ind].event_type) &&
s_usf_input_devs[ind].prepare_dev) {
rc = (*s_usf_input_devs[ind].prepare_dev)(
ind,
usf_info,
input_info,
s_usf_input_devs[ind].input_dev_name);
if (rc)
return rc;
if (usf_info->event_src)
input_set_capability(usf_info->input_ifs[ind],
EV_KEY,
usf_info->event_src);
rc = input_register_device(usf_info->input_ifs[ind]);
if (rc) {
pr_err("%s: input_reg_dev() failed; rc=%d\n",
__func__, rc);
input_free_device(usf_info->input_ifs[ind]);
usf_info->input_ifs[ind] = NULL;
} else {
usf_info->event_types |=
s_usf_input_devs[ind].event_type;
pr_debug("%s: input device[%s] was registered\n",
__func__,
s_usf_input_devs[ind].input_dev_name);
}
} /* supported event */
} /* event types loop */
ret = usf_register_conflicting_events(
input_info->conflicting_event_types);
if (ret)
usf_info->conflicting_event_types =
input_info->conflicting_event_types;
return 0;
}
static void handle_input_event(struct usf_type *usf_info,
uint16_t event_counter,
struct usf_event_type *event)
{
uint16_t ind = 0;
uint16_t events_num = 0;
struct usf_event_type usf_events[USF_EVENTS_PORTION_SIZE];
int rc = 0;
if ((usf_info == NULL) ||
(event == NULL) || (!event_counter)) {
return;
}
while (event_counter > 0) {
if (event_counter > USF_EVENTS_PORTION_SIZE) {
events_num = USF_EVENTS_PORTION_SIZE;
event_counter -= USF_EVENTS_PORTION_SIZE;
} else {
events_num = event_counter;
event_counter = 0;
}
rc = copy_from_user(usf_events,
event,
events_num * sizeof(struct usf_event_type));
if (rc) {
pr_err("%s: copy upd_rx_info from user; rc=%d\n",
__func__, rc);
return;
}
for (ind = 0; ind < events_num; ++ind) {
struct usf_event_type *p_event = &usf_events[ind];
uint16_t if_ind = p_event->event_type_ind;
if ((if_ind >= USF_MAX_EVENT_IND) ||
(usf_info->input_ifs[if_ind] == NULL))
continue; /* event isn't supported */
if (s_usf_input_devs[if_ind].notify_event)
(*s_usf_input_devs[if_ind].notify_event)(
usf_info,
if_ind,
p_event);
} /* loop in the portion */
} /* all events loop */
}
static int usf_start_tx(struct usf_xx_type *usf_xx)
{
int rc = q6usm_run(usf_xx->usc, 0, 0, 0);
pr_debug("%s: tx: q6usm_run; rc=%d\n", __func__, rc);
if (!rc) {
if (usf_xx->buffer_count >= USM_MIN_BUF_CNT) {
/* supply all buffers */
rc = q6usm_read(usf_xx->usc,
usf_xx->buffer_count);
pr_debug("%s: q6usm_read[%d]\n",
__func__, rc);
if (rc)
pr_err("%s: buf read failed",
__func__);
else
usf_xx->usf_state =
USF_WORK_STATE;
} else
usf_xx->usf_state =
USF_WORK_STATE;
}
return rc;
} /* usf_start_tx */
static int usf_start_rx(struct usf_xx_type *usf_xx)
{
int rc = q6usm_run(usf_xx->usc, 0, 0, 0);
pr_debug("%s: rx: q6usm_run; rc=%d\n",
__func__, rc);
if (!rc)
usf_xx->usf_state = USF_WORK_STATE;
return rc;
} /* usf_start_rx */
static int usf_set_us_detection(struct usf_type *usf, unsigned long arg)
{
uint32_t timeout = 0;
struct us_detect_info_type detect_info;
struct usm_session_cmd_detect_info *p_allocated_memory = NULL;
struct usm_session_cmd_detect_info usm_detect_info;
struct usm_session_cmd_detect_info *p_usm_detect_info =
&usm_detect_info;
uint32_t detect_info_size = sizeof(struct usm_session_cmd_detect_info);
struct usf_xx_type *usf_xx = &usf->usf_tx;
int rc = copy_from_user(&detect_info,
(void *) arg,
sizeof(detect_info));
if (rc) {
pr_err("%s: copy detect_info from user; rc=%d\n",
__func__, rc);
return -EFAULT;
}
if (detect_info.us_detector != US_DETECT_FW) {
pr_err("%s: unsupported detector: %d\n",
__func__, detect_info.us_detector);
return -EINVAL;
}
if ((detect_info.params_data_size != 0) &&
(detect_info.params_data != NULL)) {
uint8_t *p_data = NULL;
detect_info_size += detect_info.params_data_size;
p_allocated_memory = kzalloc(detect_info_size, GFP_KERNEL);
if (p_allocated_memory == NULL) {
pr_err("%s: detect_info[%d] allocation failed\n",
__func__, detect_info_size);
return -ENOMEM;
}
p_usm_detect_info = p_allocated_memory;
p_data = (uint8_t *)p_usm_detect_info +
sizeof(struct usm_session_cmd_detect_info);
rc = copy_from_user(p_data,
(void *)detect_info.params_data,
detect_info.params_data_size);
if (rc) {
pr_err("%s: copy params from user; rc=%d\n",
__func__, rc);
kfree(p_allocated_memory);
return -EFAULT;
}
p_usm_detect_info->algorithm_cfg_size =
detect_info.params_data_size;
} else
usm_detect_info.algorithm_cfg_size = 0;
p_usm_detect_info->detect_mode = detect_info.us_detect_mode;
p_usm_detect_info->skip_interval = detect_info.skip_time;
usf_xx->us_detect_type = USF_US_DETECT_UNDEF;
rc = q6usm_set_us_detection(usf_xx->usc,
p_usm_detect_info,
detect_info_size);
if (rc || (detect_info.detect_timeout == USF_NO_WAIT_TIMEOUT)) {
kfree(p_allocated_memory);
return rc;
}
/* Get US detection result */
if (detect_info.detect_timeout == USF_INFINITIVE_TIMEOUT) {
rc = wait_event_interruptible(usf_xx->wait,
(usf_xx->us_detect_type !=
USF_US_DETECT_UNDEF));
} else {
if (detect_info.detect_timeout == USF_DEFAULT_TIMEOUT)
timeout = USF_TIMEOUT_JIFFIES;
else
timeout = detect_info.detect_timeout * HZ;
}
rc = wait_event_interruptible_timeout(usf_xx->wait,
(usf_xx->us_detect_type !=
USF_US_DETECT_UNDEF),
timeout);
/* In the case of timeout, "no US" is assumed */
if (rc < 0)
pr_err("%s: Getting US detection failed rc[%d]\n",
__func__, rc);
else {
usf->usf_rx.us_detect_type = usf->usf_tx.us_detect_type;
detect_info.is_us =
(usf_xx->us_detect_type == USF_US_DETECT_YES);
rc = copy_to_user((void __user *)arg,
&detect_info,
sizeof(detect_info));
if (rc) {
pr_err("%s: copy detect_info to user; rc=%d\n",
__func__, rc);
rc = -EFAULT;
}
}
kfree(p_allocated_memory);
return rc;
} /* usf_set_us_detection */
static int usf_set_tx_info(struct usf_type *usf, unsigned long arg)
{
struct us_tx_info_type config_tx;
const char *name = NULL;
struct usf_xx_type *usf_xx = &usf->usf_tx;
int rc = copy_from_user(&config_tx,
(void *) arg,
sizeof(config_tx));
if (rc) {
pr_err("%s: copy config_tx from user; rc=%d\n",
__func__, rc);
return -EFAULT;
}
name = config_tx.us_xx_info.client_name;
usf_xx->new_region = USM_UNDEF_TOKEN;
usf_xx->prev_region = USM_UNDEF_TOKEN;
usf_xx->cb = usf_tx_cb;
init_waitqueue_head(&usf_xx->wait);
if (name != NULL) {
int res = strncpy_from_user(
usf_xx->client_name,
name,
sizeof(usf_xx->client_name)-1);
if (res < 0) {
pr_err("%s: get client name failed\n",
__func__);
return -EINVAL;
}
}
rc = config_xx(usf_xx, &config_tx.us_xx_info);
if (rc)
return rc;
rc = q6usm_open_read(usf_xx->usc,
usf_xx->encdec_cfg.format_id);
if (rc)
return rc;
rc = q6usm_us_client_buf_alloc(OUT, usf_xx->usc,
usf_xx->buffer_size,
usf_xx->buffer_count);
if (rc) {
(void)q6usm_cmd(usf_xx->usc, CMD_CLOSE);
return rc;
}
rc = q6usm_enc_cfg_blk(usf_xx->usc,
&usf_xx->encdec_cfg);
if (!rc &&
(config_tx.input_info.event_types != USF_NO_EVENT)) {
rc = register_input_device(usf,
&config_tx.input_info);
}
if (rc)
(void)q6usm_cmd(usf_xx->usc, CMD_CLOSE);
else
usf_xx->usf_state = USF_CONFIGURED_STATE;
return rc;
} /* usf_set_tx_info */
static int usf_set_rx_info(struct usf_type *usf, unsigned long arg)
{
struct us_rx_info_type config_rx;
struct usf_xx_type *usf_xx = &usf->usf_rx;
int rc = copy_from_user(&config_rx,
(void *) arg,
sizeof(config_rx));
if (rc) {
pr_err("%s: copy config_rx from user; rc=%d\n",
__func__, rc);
return -EFAULT;
}
usf_xx->new_region = USM_UNDEF_TOKEN;
usf_xx->prev_region = USM_UNDEF_TOKEN;
usf_xx->cb = usf_rx_cb;
rc = config_xx(usf_xx, &config_rx.us_xx_info);
if (rc)
return rc;
rc = q6usm_open_write(usf_xx->usc,
usf_xx->encdec_cfg.format_id);
if (rc)
return rc;
rc = q6usm_us_client_buf_alloc(
IN,
usf_xx->usc,
usf_xx->buffer_size,
usf_xx->buffer_count);
if (rc) {
(void)q6usm_cmd(usf_xx->usc, CMD_CLOSE);
return rc;
}
rc = q6usm_dec_cfg_blk(usf_xx->usc,
&usf_xx->encdec_cfg);
if (rc)
(void)q6usm_cmd(usf_xx->usc, CMD_CLOSE);
else {
init_waitqueue_head(&usf_xx->wait);
usf_xx->usf_state = USF_CONFIGURED_STATE;
}
return rc;
} /* usf_set_rx_info */
static int usf_get_tx_update(struct usf_type *usf, unsigned long arg)
{
struct us_tx_update_info_type upd_tx_info;
unsigned long prev_jiffies = 0;
uint32_t timeout = 0;
struct usf_xx_type *usf_xx = &usf->usf_tx;
int rc = copy_from_user(&upd_tx_info, (void *) arg,
sizeof(upd_tx_info));
if (rc) {
pr_err("%s: copy upd_tx_info from user; rc=%d\n",
__func__, rc);
return -EFAULT;
}
if (!usf_xx->user_upd_info_na) {
usf_set_event_filters(usf, upd_tx_info.event_filters);
handle_input_event(usf,
upd_tx_info.event_counter,
upd_tx_info.event);
/* Release available regions */
rc = q6usm_read(usf_xx->usc,
upd_tx_info.free_region);
if (rc)
return rc;
} else
usf_xx->user_upd_info_na = 0;
/* Get data ready regions */
if (upd_tx_info.timeout == USF_INFINITIVE_TIMEOUT) {
rc = wait_event_interruptible(usf_xx->wait,
(usf_xx->prev_region !=
usf_xx->new_region) ||
(usf_xx->usf_state !=
USF_WORK_STATE));
} else {
if (upd_tx_info.timeout == USF_NO_WAIT_TIMEOUT)
rc = (usf_xx->prev_region != usf_xx->new_region);
else {
prev_jiffies = jiffies;
if (upd_tx_info.timeout == USF_DEFAULT_TIMEOUT) {
timeout = USF_TIMEOUT_JIFFIES;
rc = wait_event_timeout(
usf_xx->wait,
(usf_xx->prev_region !=
usf_xx->new_region) ||
(usf_xx->usf_state !=
USF_WORK_STATE),
timeout);
} else {
timeout = upd_tx_info.timeout * HZ;
rc = wait_event_interruptible_timeout(
usf_xx->wait,
(usf_xx->prev_region !=
usf_xx->new_region) ||
(usf_xx->usf_state !=
USF_WORK_STATE),
timeout);
}
}
if (!rc) {
pr_debug("%s: timeout. prev_j=%lu; j=%lu\n",
__func__, prev_jiffies, jiffies);
pr_debug("%s: timeout. prev=%d; new=%d\n",
__func__, usf_xx->prev_region,
usf_xx->new_region);
pr_debug("%s: timeout. free_region=%d;\n",
__func__, upd_tx_info.free_region);
if (usf_xx->prev_region ==
usf_xx->new_region) {
pr_err("%s:read data: timeout\n",
__func__);
return -ETIME;
}
}
}
if ((usf_xx->usf_state != USF_WORK_STATE) ||
(rc == -ERESTARTSYS)) {
pr_err("%s: Get ready region failure; state[%d]; rc[%d]\n",
__func__, usf_xx->usf_state, rc);
return -EINTR;
}
upd_tx_info.ready_region = usf_xx->new_region;
usf_xx->prev_region = upd_tx_info.ready_region;
if (upd_tx_info.ready_region == USM_WRONG_TOKEN) {
pr_err("%s: TX path corrupted; prev=%d\n",
__func__, usf_xx->prev_region);
return -EIO;
}
rc = copy_to_user((void __user *)arg, &upd_tx_info,
sizeof(upd_tx_info));
if (rc) {
pr_err("%s: copy upd_tx_info to user; rc=%d\n",
__func__, rc);
rc = -EFAULT;
}
return rc;
} /* usf_get_tx_update */
static int usf_set_rx_update(struct usf_xx_type *usf_xx, unsigned long arg)
{
struct us_rx_update_info_type upd_rx_info;
int rc = copy_from_user(&upd_rx_info, (void *) arg,
sizeof(upd_rx_info));
if (rc) {
pr_err("%s: copy upd_rx_info from user; rc=%d\n",
__func__, rc);
return -EFAULT;
}
/* Send available data regions */
if (upd_rx_info.ready_region !=
usf_xx->buffer_count) {
rc = q6usm_write(
usf_xx->usc,
upd_rx_info.ready_region);
if (rc)
return rc;
}
/* Get free regions */
rc = wait_event_timeout(
usf_xx->wait,
!q6usm_is_write_buf_full(
usf_xx->usc,
&upd_rx_info.free_region) ||
(usf_xx->usf_state == USF_IDLE_STATE),
USF_TIMEOUT_JIFFIES);
if (!rc) {
rc = -ETIME;
pr_err("%s:timeout. wait for write buf not full\n",
__func__);
} else {
if (usf_xx->usf_state !=
USF_WORK_STATE) {
pr_err("%s: RX: state[%d]\n",
__func__,
usf_xx->usf_state);
rc = -EINTR;
} else {
rc = copy_to_user(
(void __user *)arg,
&upd_rx_info,
sizeof(upd_rx_info));
if (rc) {
pr_err("%s: copy rx_info to user; rc=%d\n",
__func__, rc);
rc = -EFAULT;
}
}
}
return rc;
} /* usf_set_rx_update */
static void usf_release_input(struct usf_type *usf)
{
uint16_t ind = 0;
usf_unregister_conflicting_events(
usf->conflicting_event_types);
usf->conflicting_event_types = 0;
for (ind = 0; ind < USF_MAX_EVENT_IND; ++ind) {
if (usf->input_ifs[ind] == NULL)
continue;
input_unregister_device(usf->input_ifs[ind]);
usf->input_ifs[ind] = NULL;
pr_debug("%s input_unregister_device[%s]\n",
__func__,
s_usf_input_devs[ind].input_dev_name);
}
} /* usf_release_input */
static int usf_stop_tx(struct usf_type *usf)
{
struct usf_xx_type *usf_xx = &usf->usf_tx;
usf_release_input(usf);
usf_disable(usf_xx);
return 0;
} /* usf_stop_tx */
static int usf_get_version(unsigned long arg)
{
struct us_version_info_type version_info;
int rc = copy_from_user(&version_info, (void *) arg,
sizeof(version_info));
if (rc) {
pr_err("%s: copy version_info from user; rc=%d\n",
__func__, rc);
return -EFAULT;
}
if (version_info.buf_size < sizeof(DRV_VERSION)) {
pr_err("%s: buf_size (%d) < version string size (%d)\n",
__func__, version_info.buf_size, sizeof(DRV_VERSION));
return -EINVAL;
}
rc = copy_to_user(version_info.pbuf,
DRV_VERSION,
sizeof(DRV_VERSION));
if (rc) {
pr_err("%s: copy to version_info.pbuf; rc=%d\n",
__func__, rc);
rc = -EFAULT;
}
rc = copy_to_user((void __user *)arg,
&version_info,
sizeof(version_info));
if (rc) {
pr_err("%s: copy version_info to user; rc=%d\n",
__func__, rc);
rc = -EFAULT;
}
return rc;
} /* usf_get_version */
static long usf_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
{
int rc = 0;
struct usf_type *usf = file->private_data;
struct usf_xx_type *usf_xx = NULL;
switch (cmd) {
case US_START_TX: {
usf_xx = &usf->usf_tx;
if (usf_xx->usf_state == USF_CONFIGURED_STATE)
rc = usf_start_tx(usf_xx);
else {
pr_err("%s: start_tx: wrong state[%d]\n",
__func__,
usf_xx->usf_state);
return -EBADFD;
}
break;
}
case US_START_RX: {
usf_xx = &usf->usf_rx;
if (usf_xx->usf_state == USF_CONFIGURED_STATE)
rc = usf_start_rx(usf_xx);
else {
pr_err("%s: start_rx: wrong state[%d]\n",
__func__,
usf_xx->usf_state);
return -EBADFD;
}
break;
}
case US_SET_TX_INFO: {
usf_xx = &usf->usf_tx;
if (usf_xx->usf_state == USF_OPENED_STATE)
rc = usf_set_tx_info(usf, arg);
else {
pr_err("%s: set_tx_info: wrong state[%d]\n",
__func__,
usf_xx->usf_state);
return -EBADFD;
}
break;
} /* US_SET_TX_INFO */
case US_SET_RX_INFO: {
usf_xx = &usf->usf_rx;
if (usf_xx->usf_state == USF_OPENED_STATE)
rc = usf_set_rx_info(usf, arg);
else {
pr_err("%s: set_rx_info: wrong state[%d]\n",
__func__,
usf_xx->usf_state);
return -EBADFD;
}
break;
} /* US_SET_RX_INFO */
case US_GET_TX_UPDATE: {
struct usf_xx_type *usf_xx = &usf->usf_tx;
if (usf_xx->usf_state == USF_WORK_STATE)
rc = usf_get_tx_update(usf, arg);
else {
pr_err("%s: get_tx_update: wrong state[%d]\n", __func__,
usf_xx->usf_state);
rc = -EBADFD;
}
break;
} /* US_GET_TX_UPDATE */
case US_SET_RX_UPDATE: {
struct usf_xx_type *usf_xx = &usf->usf_rx;
if (usf_xx->usf_state == USF_WORK_STATE)
rc = usf_set_rx_update(usf_xx, arg);
else {
pr_err("%s: set_rx_update: wrong state[%d]\n",
__func__,
usf_xx->usf_state);
rc = -EBADFD;
}
break;
} /* US_SET_RX_UPDATE */
case US_STOP_TX: {
usf_xx = &usf->usf_tx;
if (usf_xx->usf_state == USF_WORK_STATE)
rc = usf_stop_tx(usf);
else {
pr_err("%s: stop_tx: wrong state[%d]\n",
__func__,
usf_xx->usf_state);
return -EBADFD;
}
break;
} /* US_STOP_TX */
case US_STOP_RX: {
usf_xx = &usf->usf_rx;
if (usf_xx->usf_state == USF_WORK_STATE)
usf_disable(usf_xx);
else {
pr_err("%s: stop_rx: wrong state[%d]\n",
__func__,
usf_xx->usf_state);
return -EBADFD;
}
break;
} /* US_STOP_RX */
case US_SET_DETECTION: {
struct usf_xx_type *usf_xx = &usf->usf_tx;
if (usf_xx->usf_state == USF_WORK_STATE)
rc = usf_set_us_detection(usf, arg);
else {
pr_err("%s: set us detection: wrong state[%d]\n",
__func__,
usf_xx->usf_state);
rc = -EBADFD;
}
break;
} /* US_SET_DETECTION */
case US_GET_VERSION: {
rc = usf_get_version(arg);
break;
} /* US_GET_VERSION */
default:
pr_err("%s: unsupported IOCTL command [%d]\n",
__func__,
cmd);
rc = -ENOTTY;
break;
}
if (rc &&
((cmd == US_SET_TX_INFO) ||
(cmd == US_SET_RX_INFO)))
release_xx(usf_xx);
return rc;
} /* usf_ioctl */
static int usf_mmap(struct file *file, struct vm_area_struct *vms)
{
struct usf_type *usf = file->private_data;
int dir = OUT;
struct usf_xx_type *usf_xx = &usf->usf_tx;
if (vms->vm_flags & USF_VM_WRITE) { /* RX buf mapping */
dir = IN;
usf_xx = &usf->usf_rx;
}
return q6usm_get_virtual_address(dir, usf_xx->usc, vms);
}
static uint16_t add_opened_dev(int minor)
{
uint16_t ind = 0;
for (ind = 0; ind < MAX_DEVS_NUMBER; ++ind) {
if (minor == s_opened_devs[ind]) {
pr_err("%s: device %d is already opened\n",
__func__, minor);
return USF_UNDEF_DEV_ID;
}
if (s_opened_devs[ind] == 0) {
s_opened_devs[ind] = minor;
pr_debug("%s: device %d is added; ind=%d\n",
__func__, minor, ind);
return ind;
}
}
pr_err("%s: there is no place for device %d\n",
__func__, minor);
return USF_UNDEF_DEV_ID;
}
static int usf_open(struct inode *inode, struct file *file)
{
struct usf_type *usf = NULL;
uint16_t dev_ind = 0;
int minor = MINOR(inode->i_rdev);
dev_ind = add_opened_dev(minor);
if (dev_ind == USF_UNDEF_DEV_ID)
return -EBUSY;
usf = kzalloc(sizeof(struct usf_type), GFP_KERNEL);
if (usf == NULL) {
pr_err("%s:usf allocation failed\n", __func__);
return -ENOMEM;
}
file->private_data = usf;
usf->dev_ind = dev_ind;
usf->usf_tx.usf_state = USF_OPENED_STATE;
usf->usf_rx.usf_state = USF_OPENED_STATE;
usf->usf_tx.us_detect_type = USF_US_DETECT_UNDEF;
usf->usf_rx.us_detect_type = USF_US_DETECT_UNDEF;
pr_debug("%s:usf in open\n", __func__);
return 0;
}
static int usf_release(struct inode *inode, struct file *file)
{
struct usf_type *usf = file->private_data;
pr_debug("%s: release entry\n", __func__);
usf_release_input(usf);
usf_disable(&usf->usf_tx);
usf_disable(&usf->usf_rx);
s_opened_devs[usf->dev_ind] = 0;
kfree(usf);
pr_debug("%s: release exit\n", __func__);
return 0;
}
static const struct file_operations usf_fops = {
.owner = THIS_MODULE,
.open = usf_open,
.release = usf_release,
.unlocked_ioctl = usf_ioctl,
.mmap = usf_mmap,
};
struct miscdevice usf_misc[MAX_DEVS_NUMBER] = {
{
.minor = MISC_DYNAMIC_MINOR,
.name = "usf1",
.fops = &usf_fops,
},
};
static int __init usf_init(void)
{
int rc = 0;
uint16_t ind = 0;
pr_debug("%s: USF SW version %s.\n", __func__, DRV_VERSION);
pr_debug("%s: Max %d devs registration\n", __func__, MAX_DEVS_NUMBER);
for (ind = 0; ind < MAX_DEVS_NUMBER; ++ind) {
rc = misc_register(&usf_misc[ind]);
if (rc) {
pr_err("%s: misc_register() failed ind=%d; rc = %d\n",
__func__, ind, rc);
break;
}
}
return rc;
}
device_initcall(usf_init);
MODULE_DESCRIPTION("Ultrasound framework driver");
Reference in New Issue Copy Permalink