static long q6_evrc_in_ioctl(struct file *file, unsigned int cmd,
unsigned long arg)
{
struct evrc *evrc = file->private_data;
int rc = 0;
mutex_lock(&evrc->lock);
switch (cmd) {
case AUDIO_SET_VOLUME:
break;
case AUDIO_GET_STATS:
{
struct msm_audio_stats stats;
memset(&stats, 0, sizeof(stats));
if (copy_to_user((void *) arg, &stats, sizeof(stats)))
return -EFAULT;
return 0;
}
case AUDIO_START:
{
uint32_t acdb_id;
if (arg == 0) {
acdb_id = 0;
} else {
if (copy_from_user(&acdb_id, (void *) arg,
sizeof(acdb_id))) {
rc = -EFAULT;
break;
}
}
if (evrc->audio_client) {
rc = -EBUSY;
break;
} else {
evrc->audio_client = q6audio_open_qcp(
evrc->str_cfg.buffer_size,
evrc->cfg.min_bit_rate,
evrc->cfg.max_bit_rate,
evrc->voicerec_mode.rec_mode,
ADSP_AUDIO_FORMAT_EVRC_FS,
acdb_id);
if (!evrc->audio_client) {
kfree(evrc);
rc = -ENOMEM;
break;
}
}
break;
}
case AUDIO_STOP:
break;
case AUDIO_FLUSH:
break;
case AUDIO_SET_INCALL: {
if (copy_from_user(&evrc->voicerec_mode,
(void *)arg, sizeof(struct msm_voicerec_mode)))
rc = -EFAULT;
if (evrc->voicerec_mode.rec_mode != AUDIO_FLAG_READ
&& evrc->voicerec_mode.rec_mode !=
AUDIO_FLAG_INCALL_MIXED) {
evrc->voicerec_mode.rec_mode = AUDIO_FLAG_READ;
MM_ERR("Invalid rec_mode\n");
rc = -EINVAL;
}
break;
}
case AUDIO_GET_STREAM_CONFIG:
if (copy_to_user((void *)arg, &evrc->str_cfg,
sizeof(struct msm_audio_stream_config)))
rc = -EFAULT;
break;
case AUDIO_SET_STREAM_CONFIG:
if (copy_from_user(&evrc->str_cfg, (void *)arg,
sizeof(struct msm_audio_stream_config))) {
rc = -EFAULT;
break;
}
if (evrc->str_cfg.buffer_size < 23) {
MM_ERR("Buffer size too small\n");
rc = -EINVAL;
break;
}
if (evrc->str_cfg.buffer_count != 2)
MM_INFO("Buffer count set to 2\n");
break;
case AUDIO_SET_EVRC_ENC_CONFIG:
if (copy_from_user(&evrc->cfg, (void *) arg,
sizeof(struct msm_audio_evrc_enc_config)))
rc = -EFAULT;
if (evrc->cfg.min_bit_rate > 4 || evrc->cfg.min_bit_rate < 1) {
MM_ERR("invalid min bitrate\n");
rc = -EINVAL;
}
if (evrc->cfg.max_bit_rate > 4 || evrc->cfg.max_bit_rate < 1) {
MM_ERR("invalid max bitrate\n");
rc = -EINVAL;
}
break;
case AUDIO_GET_EVRC_ENC_CONFIG:
if (copy_to_user((void *) arg, &evrc->cfg,
sizeof(struct msm_audio_evrc_enc_config)))
rc = -EFAULT;
break;
default:
rc = -EINVAL;
}
mutex_unlock(&evrc->lock);
return rc;
}
static long q6_qcelp_in_ioctl(struct file *file, unsigned int cmd,
unsigned long arg)
{
struct qcelp *qcelp = file->private_data;
int rc = 0;
int i = 0;
struct qcelp_fc *fc;
int size = 0;
mutex_lock(&qcelp->lock);
switch (cmd) {
case AUDIO_SET_VOLUME:
break;
case AUDIO_GET_STATS:
{
struct msm_audio_stats stats;
memset(&stats, 0, sizeof(stats));
if (copy_to_user((void *) arg, &stats, sizeof(stats))) {
mutex_unlock(&qcelp->lock);
return -EFAULT;
}
mutex_unlock(&qcelp->lock);
return 0;
}
case AUDIO_START:
{
uint32_t acdb_id;
if (arg == 0) {
acdb_id = 0;
} else {
if (copy_from_user(&acdb_id,
(void *) arg, sizeof(acdb_id))) {
rc = -EFAULT;
break;
}
}
if (qcelp->audio_client) {
rc = -EBUSY;
break;
} else {
qcelp->audio_client = q6audio_open_qcp(
qcelp->str_cfg.buffer_size,
qcelp->cfg.min_bit_rate,
qcelp->cfg.max_bit_rate,
qcelp->voicerec_mode.rec_mode,
ADSP_AUDIO_FORMAT_V13K_FS,
acdb_id);
if (!qcelp->audio_client) {
kfree(qcelp);
rc = -ENOMEM;
break;
}
}
/*allocate flow control buffers*/
fc = qcelp->qcelp_fc;
size = qcelp->str_cfg.buffer_size;
for (i = 0; i < QCELP_FC_BUFF_CNT; ++i) {
mutex_init(&(fc->fc_buff[i].lock));
fc->fc_buff[i].empty = 1;
fc->fc_buff[i].data = kmalloc(size, GFP_KERNEL);
if (fc->fc_buff[i].data == NULL) {
pr_err("[%s:%s] No memory for FC buffers\n",
__MM_FILE__, __func__);
rc = -ENOMEM;
goto fc_fail;
}
fc->fc_buff[i].size = size;
fc->fc_buff[i].actual_size = 0;
}
/*create flow control thread*/
fc->task = kthread_run(q6_qcelp_flowcontrol,
qcelp, "qcelp_flowcontrol");
if (IS_ERR(fc->task)) {
rc = PTR_ERR(fc->task);
pr_err("[%s:%s] error creating flow control thread\n",
__MM_FILE__, __func__);
goto fc_fail;
}
break;
fc_fail:
/*free flow control buffers*/
--i;
for (; i >= 0; i--) {
kfree(fc->fc_buff[i].data);
fc->fc_buff[i].data = NULL;
}
break;
}
case AUDIO_STOP:
break;
case AUDIO_FLUSH:
break;
case AUDIO_SET_INCALL: {
if (copy_from_user(&qcelp->voicerec_mode,
(void *)arg, sizeof(struct msm_voicerec_mode)))
rc = -EFAULT;
if (qcelp->voicerec_mode.rec_mode != AUDIO_FLAG_READ
&& qcelp->voicerec_mode.rec_mode !=
AUDIO_FLAG_INCALL_MIXED) {
qcelp->voicerec_mode.rec_mode = AUDIO_FLAG_READ;
MM_ERR("Invalid rec_mode\n");
rc = -EINVAL;
}
break;
}
case AUDIO_GET_STREAM_CONFIG:
if (copy_to_user((void *)arg, &qcelp->str_cfg,
sizeof(struct msm_audio_stream_config)))
rc = -EFAULT;
break;
case AUDIO_SET_STREAM_CONFIG:
if (copy_from_user(&qcelp->str_cfg, (void *)arg,
sizeof(struct msm_audio_stream_config))) {
rc = -EFAULT;
break;
}
if (qcelp->str_cfg.buffer_size < 35) {
MM_ERR("Buffer size too small\n");
rc = -EINVAL;
break;
}
if (qcelp->str_cfg.buffer_count != 2)
MM_INFO("Buffer count set to 2\n");
break;
case AUDIO_SET_QCELP_ENC_CONFIG:
if (copy_from_user(&qcelp->cfg, (void *) arg,
sizeof(struct msm_audio_qcelp_enc_config)))
rc = -EFAULT;
if (qcelp->cfg.min_bit_rate > 4 ||
qcelp->cfg.min_bit_rate < 1) {
MM_ERR("invalid min bitrate\n");
rc = -EINVAL;
}
if (qcelp->cfg.max_bit_rate > 4 ||
qcelp->cfg.max_bit_rate < 1) {
MM_ERR("invalid max bitrate\n");
rc = -EINVAL;
}
break;
case AUDIO_GET_QCELP_ENC_CONFIG:
if (copy_to_user((void *) arg, &qcelp->cfg,
sizeof(struct msm_audio_qcelp_enc_config)))
rc = -EFAULT;
break;
default:
rc = -EINVAL;
}
mutex_unlock(&qcelp->lock);
return rc;
}
static long q6_evrc_in_ioctl(struct file *file, unsigned int cmd,
unsigned long arg)
{
struct evrc *evrc = file->private_data;
int rc = 0;
int i = 0;
struct evrc_fc *fc;
int size = 0;
mutex_lock(&evrc->lock);
switch (cmd) {
case AUDIO_SET_VOLUME:
pr_debug("[%s:%s] SET_VOLUME\n", __MM_FILE__, __func__);
break;
case AUDIO_GET_STATS:
{
struct msm_audio_stats stats;
pr_debug("[%s:%s] GET_STATS\n", __MM_FILE__, __func__);
memset(&stats, 0, sizeof(stats));
if (copy_to_user((void *) arg, &stats, sizeof(stats)))
return -EFAULT;
return 0;
}
case AUDIO_START:
{
uint32_t acdb_id;
pr_debug("[%s:%s] AUDIO_START\n", __MM_FILE__, __func__);
if (arg == 0) {
acdb_id = 0;
} else {
if (copy_from_user(&acdb_id, (void *) arg,
sizeof(acdb_id))) {
rc = -EFAULT;
break;
}
}
if (evrc->audio_client) {
rc = -EBUSY;
pr_err("[%s:%s] active session already existing\n",
__MM_FILE__, __func__);
break;
} else {
evrc->audio_client = q6audio_open_qcp(
evrc->str_cfg.buffer_size,
evrc->cfg.min_bit_rate,
evrc->cfg.max_bit_rate,
evrc->voicerec_mode.rec_mode,
ADSP_AUDIO_FORMAT_EVRC_FS,
acdb_id);
if (!evrc->audio_client) {
pr_err("[%s:%s] evrc open session failed\n",
__MM_FILE__, __func__);
kfree(evrc);
rc = -ENOMEM;
break;
}
}
/*allocate flow control buffers*/
fc = evrc->evrc_fc;
size = evrc->str_cfg.buffer_size;
for (i = 0; i < EVRC_FC_BUFF_CNT; ++i) {
mutex_init(&(fc->fc_buff[i].lock));
fc->fc_buff[i].empty = 1;
fc->fc_buff[i].data = kmalloc(size, GFP_KERNEL);
if (fc->fc_buff[i].data == NULL) {
pr_err("[%s:%s] No memory for FC buffers\n",
__MM_FILE__, __func__);
rc = -ENOMEM;
goto fc_fail;
}
fc->fc_buff[i].size = size;
fc->fc_buff[i].actual_size = 0;
}
/*create flow control thread*/
fc->task = kthread_run(q6_evrc_flowcontrol,
evrc, "evrc_flowcontrol");
if (IS_ERR(fc->task)) {
rc = PTR_ERR(fc->task);
pr_err("[%s:%s] error creating flow control thread\n",
__MM_FILE__, __func__);
goto fc_fail;
}
break;
fc_fail:
/*free flow control buffers*/
--i;
for (; i >= 0; i--) {
kfree(fc->fc_buff[i].data);
fc->fc_buff[i].data = NULL;
}
break;
}
case AUDIO_STOP:
pr_debug("[%s:%s] AUDIO_STOP\n", __MM_FILE__, __func__);
break;
case AUDIO_FLUSH:
break;
case AUDIO_SET_INCALL: {
pr_debug("[%s:%s] SET_INCALL\n", __MM_FILE__, __func__);
if (copy_from_user(&evrc->voicerec_mode,
(void *)arg, sizeof(struct msm_voicerec_mode)))
rc = -EFAULT;
if (evrc->voicerec_mode.rec_mode != AUDIO_FLAG_READ
&& evrc->voicerec_mode.rec_mode !=
AUDIO_FLAG_INCALL_MIXED) {
evrc->voicerec_mode.rec_mode = AUDIO_FLAG_READ;
pr_err("[%s:%s] Invalid rec_mode\n", __MM_FILE__,
__func__);
rc = -EINVAL;
}
break;
}
case AUDIO_GET_STREAM_CONFIG:
if (copy_to_user((void *)arg, &evrc->str_cfg,
sizeof(struct msm_audio_stream_config)))
rc = -EFAULT;
pr_debug("[%s:%s] GET_STREAM_CONFIG: buffsz=%d, buffcnt=%d\n",
__MM_FILE__, __func__, evrc->str_cfg.buffer_size,
evrc->str_cfg.buffer_count);
break;
case AUDIO_SET_STREAM_CONFIG:
if (copy_from_user(&evrc->str_cfg, (void *)arg,
sizeof(struct msm_audio_stream_config))) {
rc = -EFAULT;
break;
}
pr_debug("[%s:%s] SET_STREAM_CONFIG: buffsz=%d, buffcnt=%d\n",
__MM_FILE__, __func__, evrc->str_cfg.buffer_size,
evrc->str_cfg.buffer_count);
if (evrc->str_cfg.buffer_size < 23) {
pr_err("[%s:%s] Buffer size too small\n", __MM_FILE__,
__func__);
rc = -EINVAL;
break;
}
if (evrc->str_cfg.buffer_count != 2)
pr_info("[%s:%s] Buffer count set to 2\n", __MM_FILE__,
__func__);
break;
case AUDIO_SET_EVRC_ENC_CONFIG:
if (copy_from_user(&evrc->cfg, (void *) arg,
sizeof(struct msm_audio_evrc_enc_config)))
rc = -EFAULT;
pr_debug("[%s:%s] SET_EVRC_ENC_CONFIG\n", __MM_FILE__,
__func__);
if (evrc->cfg.min_bit_rate > 4 || evrc->cfg.min_bit_rate < 1) {
pr_err("[%s:%s] invalid min bitrate\n", __MM_FILE__,
__func__);
rc = -EINVAL;
}
if (evrc->cfg.max_bit_rate > 4 || evrc->cfg.max_bit_rate < 1) {
pr_err("[%s:%s] invalid max bitrate\n", __MM_FILE__,
__func__);
rc = -EINVAL;
}
break;
case AUDIO_GET_EVRC_ENC_CONFIG:
if (copy_to_user((void *) arg, &evrc->cfg,
sizeof(struct msm_audio_evrc_enc_config)))
rc = -EFAULT;
pr_debug("[%s:%s] GET_EVRC_ENC_CONFIG\n", __MM_FILE__,
__func__);
break;
default:
rc = -EINVAL;
}
mutex_unlock(&evrc->lock);
pr_debug("[%s:%s] rc = %d\n", __MM_FILE__, __func__, rc);
return rc;
}
