| /* |
| * amrnb audio input device |
| * |
| * Copyright (C) 2008 Google, Inc. |
| * Copyright (C) 2008 HTC Corporation |
| * Copyright (c) 2009-2012, The Linux Foundation. All rights reserved. |
| * |
| * This software is licensed under the terms of the GNU General Public |
| * License version 2, as published by the Free Software Foundation, and |
| * may be copied, distributed, and modified under those terms. |
| * |
| * 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 <asm/atomic.h> |
| #include <asm/ioctls.h> |
| |
| #include <linux/module.h> |
| #include <linux/fs.h> |
| #include <linux/miscdevice.h> |
| #include <linux/uaccess.h> |
| #include <linux/sched.h> |
| #include <linux/wait.h> |
| #include <linux/dma-mapping.h> |
| #include <linux/msm_audio_amrnb.h> |
| #include <linux/msm_ion.h> |
| #include <linux/memory_alloc.h> |
| |
| #include <mach/iommu.h> |
| #include <mach/iommu_domains.h> |
| #include <mach/msm_adsp.h> |
| #include <mach/socinfo.h> |
| #include <mach/qdsp5v2/qdsp5audreccmdi.h> |
| #include <mach/qdsp5v2/qdsp5audrecmsg.h> |
| #include <mach/qdsp5v2/audpreproc.h> |
| #include <mach/qdsp5v2/audio_dev_ctl.h> |
| #include <mach/debug_mm.h> |
| #include <mach/msm_memtypes.h> |
| |
| /* FRAME_NUM must be a power of two */ |
| #define FRAME_NUM (8) |
| #define FRAME_SIZE (22 * 2) /* 36 bytes data */ |
| #define DMASZ (FRAME_SIZE * FRAME_NUM) |
| |
| struct buffer { |
| void *data; |
| uint32_t size; |
| uint32_t read; |
| uint32_t addr; |
| }; |
| |
| struct audio_in { |
| struct buffer in[FRAME_NUM]; |
| |
| spinlock_t dsp_lock; |
| |
| atomic_t in_bytes; |
| atomic_t in_samples; |
| |
| struct mutex lock; |
| struct mutex read_lock; |
| wait_queue_head_t wait; |
| wait_queue_head_t wait_enable; |
| |
| struct msm_adsp_module *audrec; |
| struct audrec_session_info session_info; /*audrec session info*/ |
| |
| /* configuration to use on next enable */ |
| uint32_t buffer_size; /* Frame size (36 bytes) */ |
| uint32_t enc_type; |
| |
| int dtx_mode; |
| uint32_t frame_format; |
| uint32_t used_mode; |
| uint32_t rec_mode; |
| |
| uint32_t dsp_cnt; |
| uint32_t in_head; /* next buffer dsp will write */ |
| uint32_t in_tail; /* next buffer read() will read */ |
| uint32_t in_count; /* number of buffers available to read() */ |
| uint32_t mode; |
| |
| const char *module_name; |
| unsigned queue_ids; |
| uint16_t enc_id; |
| |
| uint16_t source; /* Encoding source bit mask */ |
| uint32_t device_events; |
| uint32_t in_call; |
| uint32_t dev_cnt; |
| int voice_state; |
| spinlock_t dev_lock; |
| |
| /* data allocated for various buffers */ |
| char *data; |
| dma_addr_t phys; |
| void *map_v_read; |
| |
| int opened; |
| int enabled; |
| int running; |
| int stopped; /* set when stopped, cleared on flush */ |
| char *build_id; |
| struct ion_client *client; |
| struct ion_handle *buff_handle; |
| }; |
| |
| struct audio_frame { |
| uint16_t frame_count_lsw; |
| uint16_t frame_count_msw; |
| uint16_t frame_length; |
| uint16_t erased_pcm; |
| unsigned char raw_bitstream[]; /* samples */ |
| } __attribute__((packed)); |
| |
| /* Audrec Queue command sent macro's */ |
| #define audrec_send_bitstreamqueue(audio, cmd, len) \ |
| msm_adsp_write(audio->audrec, ((audio->queue_ids & 0xFFFF0000) >> 16),\ |
| cmd, len) |
| |
| #define audrec_send_audrecqueue(audio, cmd, len) \ |
| msm_adsp_write(audio->audrec, (audio->queue_ids & 0x0000FFFF),\ |
| cmd, len) |
| |
| struct audio_in the_audio_amrnb_in; |
| |
| /* DSP command send functions */ |
| static int audamrnb_in_enc_config(struct audio_in *audio, int enable); |
| static int audamrnb_in_param_config(struct audio_in *audio); |
| static int audamrnb_in_mem_config(struct audio_in *audio); |
| static int audamrnb_in_record_config(struct audio_in *audio, int enable); |
| static int audamrnb_dsp_read_buffer(struct audio_in *audio, uint32_t read_cnt); |
| |
| static void audamrnb_in_get_dsp_frames(struct audio_in *audio); |
| |
| static void audamrnb_in_flush(struct audio_in *audio); |
| |
| static void amrnb_in_listener(u32 evt_id, union auddev_evt_data *evt_payload, |
| void *private_data) |
| { |
| struct audio_in *audio = (struct audio_in *) private_data; |
| unsigned long flags; |
| |
| MM_DBG("evt_id = 0x%8x\n", evt_id); |
| switch (evt_id) { |
| case AUDDEV_EVT_DEV_RDY: { |
| MM_DBG("AUDDEV_EVT_DEV_RDY\n"); |
| spin_lock_irqsave(&audio->dev_lock, flags); |
| audio->dev_cnt++; |
| if (!audio->in_call) |
| audio->source |= (0x1 << evt_payload->routing_id); |
| spin_unlock_irqrestore(&audio->dev_lock, flags); |
| |
| if ((audio->running == 1) && (audio->enabled == 1)) |
| audamrnb_in_record_config(audio, 1); |
| |
| break; |
| } |
| case AUDDEV_EVT_DEV_RLS: { |
| MM_DBG("AUDDEV_EVT_DEV_RLS\n"); |
| spin_lock_irqsave(&audio->dev_lock, flags); |
| audio->dev_cnt--; |
| if (!audio->in_call) |
| audio->source &= ~(0x1 << evt_payload->routing_id); |
| spin_unlock_irqrestore(&audio->dev_lock, flags); |
| |
| if ((!audio->running) || (!audio->enabled)) |
| break; |
| |
| /* Turn of as per source */ |
| if (audio->source) |
| audamrnb_in_record_config(audio, 1); |
| else |
| /* Turn off all */ |
| audamrnb_in_record_config(audio, 0); |
| |
| break; |
| } |
| case AUDDEV_EVT_VOICE_STATE_CHG: { |
| MM_DBG("AUDDEV_EVT_VOICE_STATE_CHG, state = %d\n", |
| evt_payload->voice_state); |
| audio->voice_state = evt_payload->voice_state; |
| if (audio->in_call && audio->running) { |
| if (audio->voice_state == VOICE_STATE_INCALL) |
| audamrnb_in_record_config(audio, 1); |
| else if (audio->voice_state == VOICE_STATE_OFFCALL) { |
| audamrnb_in_record_config(audio, 0); |
| wake_up(&audio->wait); |
| } |
| } |
| |
| break; |
| } |
| default: |
| MM_ERR("wrong event %d\n", evt_id); |
| break; |
| } |
| } |
| |
| /* ------------------- dsp preproc event handler--------------------- */ |
| static void audpreproc_dsp_event(void *data, unsigned id, void *msg) |
| { |
| struct audio_in *audio = data; |
| |
| switch (id) { |
| case AUDPREPROC_ERROR_MSG: { |
| struct audpreproc_err_msg *err_msg = msg; |
| |
| MM_ERR("ERROR_MSG: stream id %d err idx %d\n", |
| err_msg->stream_id, err_msg->aud_preproc_err_idx); |
| /* Error case */ |
| wake_up(&audio->wait_enable); |
| break; |
| } |
| case AUDPREPROC_CMD_CFG_DONE_MSG: { |
| MM_DBG("CMD_CFG_DONE_MSG \n"); |
| break; |
| } |
| case AUDPREPROC_CMD_ENC_CFG_DONE_MSG: { |
| struct audpreproc_cmd_enc_cfg_done_msg *enc_cfg_msg = msg; |
| |
| MM_DBG("CMD_ENC_CFG_DONE_MSG: stream id %d enc type \ |
| 0x%8x\n", enc_cfg_msg->stream_id, |
| enc_cfg_msg->rec_enc_type); |
| /* Encoder enable success */ |
| if (enc_cfg_msg->rec_enc_type & ENCODE_ENABLE) |
| audamrnb_in_param_config(audio); |
| else { /* Encoder disable success */ |
| audio->running = 0; |
| audamrnb_in_record_config(audio, 0); |
| } |
| break; |
| } |
| case AUDPREPROC_CMD_ENC_PARAM_CFG_DONE_MSG: { |
| MM_DBG("CMD_ENC_PARAM_CFG_DONE_MSG \n"); |
| audamrnb_in_mem_config(audio); |
| break; |
| } |
| case AUDPREPROC_AFE_CMD_AUDIO_RECORD_CFG_DONE_MSG: { |
| MM_DBG("AFE_CMD_AUDIO_RECORD_CFG_DONE_MSG \n"); |
| wake_up(&audio->wait_enable); |
| break; |
| } |
| default: |
| MM_ERR("Unknown Event id %d\n", id); |
| } |
| } |
| |
| /* ------------------- dsp audrec event handler--------------------- */ |
| static void audrec_dsp_event(void *data, unsigned id, size_t len, |
| void (*getevent)(void *ptr, size_t len)) |
| { |
| struct audio_in *audio = data; |
| |
| switch (id) { |
| case AUDREC_CMD_MEM_CFG_DONE_MSG: { |
| MM_DBG("CMD_MEM_CFG_DONE MSG DONE\n"); |
| audio->running = 1; |
| if ((!audio->in_call && (audio->dev_cnt > 0)) || |
| (audio->in_call && |
| (audio->voice_state == VOICE_STATE_INCALL))) |
| audamrnb_in_record_config(audio, 1); |
| break; |
| } |
| case AUDREC_FATAL_ERR_MSG: { |
| struct audrec_fatal_err_msg fatal_err_msg; |
| |
| getevent(&fatal_err_msg, AUDREC_FATAL_ERR_MSG_LEN); |
| MM_ERR("FATAL_ERR_MSG: err id %d\n", |
| fatal_err_msg.audrec_err_id); |
| /* Error stop the encoder */ |
| audio->stopped = 1; |
| wake_up(&audio->wait); |
| break; |
| } |
| case AUDREC_UP_PACKET_READY_MSG: { |
| struct audrec_up_pkt_ready_msg pkt_ready_msg; |
| |
| getevent(&pkt_ready_msg, AUDREC_UP_PACKET_READY_MSG_LEN); |
| MM_DBG("UP_PACKET_READY_MSG: write cnt lsw %d \ |
| write cnt msw %d read cnt lsw %d read cnt msw %d \n",\ |
| pkt_ready_msg.audrec_packet_write_cnt_lsw, \ |
| pkt_ready_msg.audrec_packet_write_cnt_msw, \ |
| pkt_ready_msg.audrec_up_prev_read_cnt_lsw, \ |
| pkt_ready_msg.audrec_up_prev_read_cnt_msw); |
| |
| audamrnb_in_get_dsp_frames(audio); |
| break; |
| } |
| case ADSP_MESSAGE_ID: { |
| MM_DBG("Received ADSP event:module audrectask\n"); |
| break; |
| } |
| default: |
| MM_ERR("Unknown Event id %d\n", id); |
| } |
| } |
| |
| static void audamrnb_in_get_dsp_frames(struct audio_in *audio) |
| { |
| struct audio_frame *frame; |
| uint32_t index; |
| unsigned long flags; |
| |
| index = audio->in_head; |
| |
| frame = (void *) (((char *)audio->in[index].data) - \ |
| sizeof(*frame)); |
| |
| spin_lock_irqsave(&audio->dsp_lock, flags); |
| audio->in[index].size = frame->frame_length; |
| |
| /* statistics of read */ |
| atomic_add(audio->in[index].size, &audio->in_bytes); |
| atomic_add(1, &audio->in_samples); |
| |
| audio->in_head = (audio->in_head + 1) & (FRAME_NUM - 1); |
| |
| /* If overflow, move the tail index foward. */ |
| if (audio->in_head == audio->in_tail) |
| audio->in_tail = (audio->in_tail + 1) & (FRAME_NUM - 1); |
| else |
| audio->in_count++; |
| |
| audamrnb_dsp_read_buffer(audio, audio->dsp_cnt++); |
| spin_unlock_irqrestore(&audio->dsp_lock, flags); |
| |
| wake_up(&audio->wait); |
| } |
| struct msm_adsp_ops audrec_amrnb_adsp_ops = { |
| .event = audrec_dsp_event, |
| }; |
| |
| static int audamrnb_in_enc_config(struct audio_in *audio, int enable) |
| { |
| struct audpreproc_audrec_cmd_enc_cfg cmd; |
| |
| memset(&cmd, 0, sizeof(cmd)); |
| if (audio->build_id[17] == '1') { |
| cmd.cmd_id = AUDPREPROC_AUDREC_CMD_ENC_CFG_2; |
| MM_ERR("sending AUDPREPROC_AUDREC_CMD_ENC_CFG_2 command"); |
| } else { |
| cmd.cmd_id = AUDPREPROC_AUDREC_CMD_ENC_CFG; |
| MM_ERR("sending AUDPREPROC_AUDREC_CMD_ENC_CFG command"); |
| } |
| cmd.stream_id = audio->enc_id; |
| |
| if (enable) |
| cmd.audrec_enc_type = audio->enc_type | ENCODE_ENABLE; |
| else |
| cmd.audrec_enc_type &= ~(ENCODE_ENABLE); |
| |
| return audpreproc_send_audreccmdqueue(&cmd, sizeof(cmd)); |
| } |
| |
| static int audamrnb_in_param_config(struct audio_in *audio) |
| { |
| struct audpreproc_audrec_cmd_parm_cfg_amrnb cmd; |
| |
| memset(&cmd, 0, sizeof(cmd)); |
| cmd.common.cmd_id = AUDPREPROC_AUDREC_CMD_PARAM_CFG; |
| cmd.common.stream_id = audio->enc_id; |
| |
| cmd.dtx_mode = audio->dtx_mode; |
| cmd.test_mode = -1; /* Default set to -1 */ |
| cmd.used_mode = audio->used_mode; |
| |
| return audpreproc_send_audreccmdqueue(&cmd, sizeof(cmd)); |
| } |
| |
| /* To Do: msm_snddev_route_enc(audio->enc_id); */ |
| static int audamrnb_in_record_config(struct audio_in *audio, int enable) |
| { |
| struct audpreproc_afe_cmd_audio_record_cfg cmd; |
| |
| memset(&cmd, 0, sizeof(cmd)); |
| cmd.cmd_id = AUDPREPROC_AFE_CMD_AUDIO_RECORD_CFG; |
| cmd.stream_id = audio->enc_id; |
| if (enable) |
| cmd.destination_activity = AUDIO_RECORDING_TURN_ON; |
| else |
| cmd.destination_activity = AUDIO_RECORDING_TURN_OFF; |
| |
| cmd.source_mix_mask = audio->source; |
| if (audio->enc_id == 2) { |
| if ((cmd.source_mix_mask & |
| INTERNAL_CODEC_TX_SOURCE_MIX_MASK) || |
| (cmd.source_mix_mask & AUX_CODEC_TX_SOURCE_MIX_MASK) || |
| (cmd.source_mix_mask & VOICE_UL_SOURCE_MIX_MASK) || |
| (cmd.source_mix_mask & VOICE_DL_SOURCE_MIX_MASK)) { |
| cmd.pipe_id = SOURCE_PIPE_1; |
| } |
| if (cmd.source_mix_mask & |
| AUDPP_A2DP_PIPE_SOURCE_MIX_MASK) |
| cmd.pipe_id |= SOURCE_PIPE_0; |
| } |
| |
| return audpreproc_send_audreccmdqueue(&cmd, sizeof(cmd)); |
| } |
| |
| static int audamrnb_in_mem_config(struct audio_in *audio) |
| { |
| struct audrec_cmd_arecmem_cfg cmd; |
| uint16_t *data = (void *) audio->data; |
| int n; |
| |
| memset(&cmd, 0, sizeof(cmd)); |
| cmd.cmd_id = AUDREC_CMD_MEM_CFG_CMD; |
| cmd.audrec_up_pkt_intm_count = 1; |
| cmd.audrec_ext_pkt_start_addr_msw = audio->phys >> 16; |
| cmd.audrec_ext_pkt_start_addr_lsw = audio->phys; |
| cmd.audrec_ext_pkt_buf_number = FRAME_NUM; |
| |
| /* prepare buffer pointers: |
| * 36 bytes amrnb packet + 4 halfword header |
| */ |
| for (n = 0; n < FRAME_NUM; n++) { |
| audio->in[n].data = data + 4; |
| data += (FRAME_SIZE/2); /* word increment */ |
| MM_DBG("0x%8x\n", (int)(audio->in[n].data - 8)); |
| } |
| |
| return audrec_send_audrecqueue(audio, &cmd, sizeof(cmd)); |
| } |
| |
| static int audamrnb_dsp_read_buffer(struct audio_in *audio, uint32_t read_cnt) |
| { |
| struct up_audrec_packet_ext_ptr cmd; |
| |
| memset(&cmd, 0, sizeof(cmd)); |
| cmd.cmd_id = UP_AUDREC_PACKET_EXT_PTR; |
| cmd.audrec_up_curr_read_count_msw = read_cnt >> 16; |
| cmd.audrec_up_curr_read_count_lsw = read_cnt; |
| |
| return audrec_send_bitstreamqueue(audio, &cmd, sizeof(cmd)); |
| } |
| |
| /* must be called with audio->lock held */ |
| static int audamrnb_in_enable(struct audio_in *audio) |
| { |
| if (audio->enabled) |
| return 0; |
| |
| if (audpreproc_enable(audio->enc_id, &audpreproc_dsp_event, audio)) { |
| MM_ERR("msm_adsp_enable(audpreproc) failed\n"); |
| return -ENODEV; |
| } |
| |
| if (msm_adsp_enable(audio->audrec)) { |
| MM_ERR("msm_adsp_enable(audrec) failed\n"); |
| audpreproc_disable(audio->enc_id, audio); |
| return -ENODEV; |
| } |
| audio->enabled = 1; |
| audamrnb_in_enc_config(audio, 1); |
| |
| return 0; |
| } |
| |
| /* must be called with audio->lock held */ |
| static int audamrnb_in_disable(struct audio_in *audio) |
| { |
| if (audio->enabled) { |
| audio->enabled = 0; |
| audamrnb_in_enc_config(audio, 0); |
| wake_up(&audio->wait); |
| wait_event_interruptible_timeout(audio->wait_enable, |
| audio->running == 0, 1*HZ); |
| msm_adsp_disable(audio->audrec); |
| audpreproc_disable(audio->enc_id, audio); |
| } |
| return 0; |
| } |
| |
| static void audamrnb_in_flush(struct audio_in *audio) |
| { |
| int i; |
| |
| audio->dsp_cnt = 0; |
| audio->in_head = 0; |
| audio->in_tail = 0; |
| audio->in_count = 0; |
| for (i = 0; i < FRAME_NUM; i++) { |
| audio->in[i].size = 0; |
| audio->in[i].read = 0; |
| } |
| MM_DBG("in_bytes %d\n", atomic_read(&audio->in_bytes)); |
| MM_DBG("in_samples %d\n", atomic_read(&audio->in_samples)); |
| atomic_set(&audio->in_bytes, 0); |
| atomic_set(&audio->in_samples, 0); |
| } |
| |
| /* ------------------- device --------------------- */ |
| static long audamrnb_in_ioctl(struct file *file, |
| unsigned int cmd, unsigned long arg) |
| { |
| struct audio_in *audio = file->private_data; |
| int rc = 0; |
| |
| if (cmd == AUDIO_GET_STATS) { |
| struct msm_audio_stats stats; |
| stats.byte_count = atomic_read(&audio->in_bytes); |
| stats.sample_count = atomic_read(&audio->in_samples); |
| if (copy_to_user((void *) arg, &stats, sizeof(stats))) |
| return -EFAULT; |
| return rc; |
| } |
| |
| mutex_lock(&audio->lock); |
| switch (cmd) { |
| case AUDIO_START: { |
| uint32_t freq; |
| freq = 48000; |
| MM_DBG("AUDIO_START\n"); |
| if (audio->in_call && (audio->voice_state != |
| VOICE_STATE_INCALL)) { |
| rc = -EPERM; |
| break; |
| } |
| rc = msm_snddev_request_freq(&freq, audio->enc_id, |
| SNDDEV_CAP_TX, AUDDEV_CLNT_ENC); |
| MM_DBG("sample rate configured %d\n", freq); |
| if (rc < 0) { |
| MM_DBG(" Sample rate can not be set, return code %d\n", |
| rc); |
| msm_snddev_withdraw_freq(audio->enc_id, |
| SNDDEV_CAP_TX, AUDDEV_CLNT_ENC); |
| MM_DBG("msm_snddev_withdraw_freq\n"); |
| break; |
| } |
| /*update aurec session info in audpreproc layer*/ |
| audio->session_info.session_id = audio->enc_id; |
| /*amrnb works only on 8KHz*/ |
| audio->session_info.sampling_freq = 8000; |
| audpreproc_update_audrec_info(&audio->session_info); |
| rc = audamrnb_in_enable(audio); |
| if (!rc) { |
| rc = |
| wait_event_interruptible_timeout(audio->wait_enable, |
| audio->running != 0, 1*HZ); |
| MM_DBG("state %d rc = %d\n", audio->running, rc); |
| |
| if (audio->running == 0) |
| rc = -ENODEV; |
| else |
| rc = 0; |
| } |
| audio->stopped = 0; |
| break; |
| } |
| case AUDIO_STOP: { |
| /*reset the sampling frequency information at audpreproc layer*/ |
| audio->session_info.sampling_freq = 0; |
| audpreproc_update_audrec_info(&audio->session_info); |
| rc = audamrnb_in_disable(audio); |
| rc = msm_snddev_withdraw_freq(audio->enc_id, |
| SNDDEV_CAP_TX, AUDDEV_CLNT_ENC); |
| MM_DBG("msm_snddev_withdraw_freq\n"); |
| audio->stopped = 1; |
| break; |
| } |
| case AUDIO_FLUSH: { |
| if (audio->stopped) { |
| /* Make sure we're stopped and we wake any threads |
| * that might be blocked holding the read_lock. |
| * While audio->stopped read threads will always |
| * exit immediately. |
| */ |
| wake_up(&audio->wait); |
| mutex_lock(&audio->read_lock); |
| audamrnb_in_flush(audio); |
| mutex_unlock(&audio->read_lock); |
| } |
| break; |
| } |
| case AUDIO_SET_STREAM_CONFIG: { |
| struct msm_audio_stream_config cfg; |
| if (copy_from_user(&cfg, (void *) arg, sizeof(cfg))) { |
| rc = -EFAULT; |
| break; |
| } |
| /* Allow only single frame */ |
| if (cfg.buffer_size != (FRAME_SIZE - 8)) |
| rc = -EINVAL; |
| else |
| audio->buffer_size = cfg.buffer_size; |
| break; |
| } |
| case AUDIO_GET_STREAM_CONFIG: { |
| struct msm_audio_stream_config cfg; |
| memset(&cfg, 0, sizeof(cfg)); |
| cfg.buffer_size = audio->buffer_size; |
| cfg.buffer_count = FRAME_NUM; |
| if (copy_to_user((void *) arg, &cfg, sizeof(cfg))) |
| rc = -EFAULT; |
| break; |
| } |
| case AUDIO_GET_AMRNB_ENC_CONFIG_V2: { |
| struct msm_audio_amrnb_enc_config_v2 cfg; |
| memset(&cfg, 0, sizeof(cfg)); |
| cfg.dtx_enable = ((audio->dtx_mode == -1) ? 1 : 0); |
| cfg.band_mode = audio->used_mode; |
| cfg.frame_format = audio->frame_format; |
| if (copy_to_user((void *) arg, &cfg, sizeof(cfg))) |
| rc = -EFAULT; |
| break; |
| } |
| case AUDIO_SET_AMRNB_ENC_CONFIG_V2: { |
| struct msm_audio_amrnb_enc_config_v2 cfg; |
| if (copy_from_user(&cfg, (void *) arg, sizeof(cfg))) { |
| rc = -EFAULT; |
| break; |
| } |
| /* DSP does not support any other than default format */ |
| if (audio->frame_format != cfg.frame_format) { |
| rc = -EINVAL; |
| break; |
| } |
| if (cfg.dtx_enable == 0) |
| audio->dtx_mode = 0; |
| else if (cfg.dtx_enable == 1) |
| audio->dtx_mode = -1; |
| else { |
| rc = -EINVAL; |
| break; |
| } |
| audio->used_mode = cfg.band_mode; |
| break; |
| } |
| case AUDIO_SET_INCALL: { |
| struct msm_voicerec_mode cfg; |
| unsigned long flags; |
| if (copy_from_user(&cfg, (void *) arg, sizeof(cfg))) { |
| rc = -EFAULT; |
| break; |
| } |
| if (cfg.rec_mode != VOC_REC_BOTH && |
| cfg.rec_mode != VOC_REC_UPLINK && |
| cfg.rec_mode != VOC_REC_DOWNLINK) { |
| MM_ERR("invalid rec_mode\n"); |
| rc = -EINVAL; |
| break; |
| } else { |
| spin_lock_irqsave(&audio->dev_lock, flags); |
| if (cfg.rec_mode == VOC_REC_UPLINK) |
| audio->source = VOICE_UL_SOURCE_MIX_MASK; |
| else if (cfg.rec_mode == VOC_REC_DOWNLINK) |
| audio->source = VOICE_DL_SOURCE_MIX_MASK; |
| else |
| audio->source = VOICE_DL_SOURCE_MIX_MASK | |
| VOICE_UL_SOURCE_MIX_MASK ; |
| audio->in_call = 1; |
| spin_unlock_irqrestore(&audio->dev_lock, flags); |
| } |
| break; |
| } |
| case AUDIO_GET_SESSION_ID: { |
| if (copy_to_user((void *) arg, &audio->enc_id, |
| sizeof(unsigned short))) { |
| rc = -EFAULT; |
| } |
| break; |
| } |
| default: |
| rc = -EINVAL; |
| } |
| mutex_unlock(&audio->lock); |
| return rc; |
| } |
| |
| static ssize_t audamrnb_in_read(struct file *file, |
| char __user *buf, |
| size_t count, loff_t *pos) |
| { |
| struct audio_in *audio = file->private_data; |
| unsigned long flags; |
| const char __user *start = buf; |
| void *data; |
| uint32_t index; |
| uint32_t size; |
| int rc = 0; |
| |
| mutex_lock(&audio->read_lock); |
| while (count > 0) { |
| rc = wait_event_interruptible( |
| audio->wait, (audio->in_count > 0) || audio->stopped |
| || (audio->in_call && audio->running && |
| (audio->voice_state == VOICE_STATE_OFFCALL))); |
| if (rc < 0) |
| break; |
| |
| if (!audio->in_count) { |
| if (audio->stopped) { |
| rc = 0;/* End of File */ |
| break; |
| } else if (audio->in_call && audio->running && |
| (audio->voice_state == VOICE_STATE_OFFCALL)) { |
| MM_DBG("Not Permitted Voice Terminated\n"); |
| rc = -EPERM; /* Voice Call stopped */ |
| break; |
| } |
| } |
| |
| index = audio->in_tail; |
| data = (uint8_t *) audio->in[index].data; |
| size = audio->in[index].size; |
| if (count >= size) { |
| if (copy_to_user(buf, data, size)) { |
| rc = -EFAULT; |
| break; |
| } |
| spin_lock_irqsave(&audio->dsp_lock, flags); |
| if (index != audio->in_tail) { |
| /* overrun -- data is |
| * invalid and we need to retry */ |
| spin_unlock_irqrestore(&audio->dsp_lock, flags); |
| continue; |
| } |
| audio->in[index].size = 0; |
| audio->in_tail = (audio->in_tail + 1) & (FRAME_NUM - 1); |
| audio->in_count--; |
| spin_unlock_irqrestore(&audio->dsp_lock, flags); |
| count -= size; |
| buf += size; |
| } else { |
| MM_ERR("short read\n"); |
| break; |
| } |
| } |
| mutex_unlock(&audio->read_lock); |
| |
| if (buf > start) |
| return buf - start; |
| |
| return rc; |
| } |
| |
| static ssize_t audamrnb_in_write(struct file *file, |
| const char __user *buf, |
| size_t count, loff_t *pos) |
| { |
| return -EINVAL; |
| } |
| |
| static int audamrnb_in_release(struct inode *inode, struct file *file) |
| { |
| struct audio_in *audio = file->private_data; |
| |
| MM_DBG("\n"); |
| mutex_lock(&audio->lock); |
| audio->in_call = 0; |
| /* with draw frequency for session |
| incase not stopped the driver */ |
| msm_snddev_withdraw_freq(audio->enc_id, SNDDEV_CAP_TX, |
| AUDDEV_CLNT_ENC); |
| auddev_unregister_evt_listner(AUDDEV_CLNT_ENC, audio->enc_id); |
| /*reset the sampling frequency information at audpreproc layer*/ |
| audio->session_info.sampling_freq = 0; |
| audpreproc_update_audrec_info(&audio->session_info); |
| audamrnb_in_disable(audio); |
| audamrnb_in_flush(audio); |
| msm_adsp_put(audio->audrec); |
| audpreproc_aenc_free(audio->enc_id); |
| audio->audrec = NULL; |
| audio->opened = 0; |
| if (audio->data) { |
| ion_unmap_kernel(audio->client, audio->buff_handle); |
| ion_free(audio->client, audio->buff_handle); |
| ion_client_destroy(audio->client); |
| audio->data = NULL; |
| } |
| mutex_unlock(&audio->lock); |
| return 0; |
| } |
| |
| static int audamrnb_in_open(struct inode *inode, struct file *file) |
| { |
| struct audio_in *audio = &the_audio_amrnb_in; |
| int rc; |
| int encid; |
| int len = 0; |
| unsigned long ionflag = 0; |
| ion_phys_addr_t addr = 0; |
| struct ion_handle *handle = NULL; |
| struct ion_client *client = NULL; |
| |
| mutex_lock(&audio->lock); |
| if (audio->opened) { |
| rc = -EBUSY; |
| goto done; |
| } |
| |
| client = msm_ion_client_create(UINT_MAX, "Audio_AMR_In_Client"); |
| if (IS_ERR_OR_NULL(client)) { |
| MM_ERR("Unable to create ION client\n"); |
| rc = -ENOMEM; |
| goto client_create_error; |
| } |
| audio->client = client; |
| |
| handle = ion_alloc(client, DMASZ, SZ_4K, |
| ION_HEAP(ION_AUDIO_HEAP_ID), 0); |
| if (IS_ERR_OR_NULL(handle)) { |
| MM_ERR("Unable to create allocate O/P buffers\n"); |
| rc = -ENOMEM; |
| goto buff_alloc_error; |
| } |
| audio->buff_handle = handle; |
| |
| rc = ion_phys(client, handle, &addr, &len); |
| if (rc) { |
| MM_ERR("O/P buffers:Invalid phy: %x sz: %x\n", |
| (unsigned int) addr, (unsigned int) len); |
| goto buff_get_phys_error; |
| } else { |
| MM_INFO("O/P buffers:valid phy: %x sz: %x\n", |
| (unsigned int) addr, (unsigned int) len); |
| } |
| audio->phys = (int32_t)addr; |
| |
| rc = ion_handle_get_flags(client, handle, &ionflag); |
| if (rc) { |
| MM_ERR("could not get flags for the handle\n"); |
| goto buff_get_flags_error; |
| } |
| |
| audio->map_v_read = ion_map_kernel(client, handle); |
| if (IS_ERR(audio->map_v_read)) { |
| MM_ERR("could not map write buffers\n"); |
| rc = -ENOMEM; |
| goto buff_map_error; |
| } |
| audio->data = audio->map_v_read; |
| MM_DBG("write buf: phy addr 0x%08x kernel addr 0x%08x\n", |
| audio->phys, (int)audio->data); |
| |
| MM_DBG("Memory addr = 0x%8x phy addr = 0x%8x\n",\ |
| (int) audio->data, (int) audio->phys); |
| if ((file->f_mode & FMODE_WRITE) && |
| (file->f_mode & FMODE_READ)) { |
| rc = -EACCES; |
| MM_ERR("Non tunnel encoding is not supported\n"); |
| goto done; |
| } else if (!(file->f_mode & FMODE_WRITE) && |
| (file->f_mode & FMODE_READ)) { |
| audio->mode = MSM_AUD_ENC_MODE_TUNNEL; |
| MM_DBG("Opened for tunnel mode encoding\n"); |
| } else { |
| rc = -EACCES; |
| goto done; |
| } |
| |
| |
| /* Settings will be re-config at AUDIO_SET_CONFIG, |
| * but at least we need to have initial config |
| */ |
| audio->buffer_size = (FRAME_SIZE - 8); |
| audio->enc_type = ENC_TYPE_AMRNB | audio->mode; |
| audio->dtx_mode = -1; |
| audio->frame_format = 0; |
| audio->used_mode = 7; /* Bit Rate 12.2 kbps MR122 */ |
| |
| encid = audpreproc_aenc_alloc(audio->enc_type, &audio->module_name, |
| &audio->queue_ids); |
| if (encid < 0) { |
| MM_ERR("No free encoder available\n"); |
| rc = -ENODEV; |
| goto done; |
| } |
| audio->enc_id = encid; |
| |
| rc = msm_adsp_get(audio->module_name, &audio->audrec, |
| &audrec_amrnb_adsp_ops, audio); |
| |
| if (rc) { |
| audpreproc_aenc_free(audio->enc_id); |
| goto done; |
| } |
| |
| audio->stopped = 0; |
| audio->source = 0; |
| |
| audamrnb_in_flush(audio); |
| |
| audio->device_events = AUDDEV_EVT_DEV_RDY | AUDDEV_EVT_DEV_RLS | |
| AUDDEV_EVT_VOICE_STATE_CHG; |
| |
| audio->voice_state = msm_get_voice_state(); |
| rc = auddev_register_evt_listner(audio->device_events, |
| AUDDEV_CLNT_ENC, audio->enc_id, |
| amrnb_in_listener, (void *) audio); |
| if (rc) { |
| MM_ERR("failed to register device event listener\n"); |
| goto evt_error; |
| } |
| audio->build_id = socinfo_get_build_id(); |
| MM_DBG("Modem build id = %s\n", audio->build_id); |
| |
| file->private_data = audio; |
| audio->opened = 1; |
| done: |
| mutex_unlock(&audio->lock); |
| return rc; |
| evt_error: |
| msm_adsp_put(audio->audrec); |
| audpreproc_aenc_free(audio->enc_id); |
| mutex_unlock(&audio->lock); |
| ion_unmap_kernel(client, audio->buff_handle); |
| buff_map_error: |
| buff_get_phys_error: |
| buff_get_flags_error: |
| ion_free(client, audio->buff_handle); |
| buff_alloc_error: |
| ion_client_destroy(client); |
| client_create_error: |
| return rc; |
| } |
| |
| static const struct file_operations audio_in_fops = { |
| .owner = THIS_MODULE, |
| .open = audamrnb_in_open, |
| .release = audamrnb_in_release, |
| .read = audamrnb_in_read, |
| .write = audamrnb_in_write, |
| .unlocked_ioctl = audamrnb_in_ioctl, |
| }; |
| |
| struct miscdevice audio_amrnb_in_misc = { |
| .minor = MISC_DYNAMIC_MINOR, |
| .name = "msm_amrnb_in", |
| .fops = &audio_in_fops, |
| }; |
| |
| static int __init audamrnb_in_init(void) |
| { |
| mutex_init(&the_audio_amrnb_in.lock); |
| mutex_init(&the_audio_amrnb_in.read_lock); |
| spin_lock_init(&the_audio_amrnb_in.dsp_lock); |
| spin_lock_init(&the_audio_amrnb_in.dev_lock); |
| init_waitqueue_head(&the_audio_amrnb_in.wait); |
| init_waitqueue_head(&the_audio_amrnb_in.wait_enable); |
| return misc_register(&audio_amrnb_in_misc); |
| } |
| |
| device_initcall(audamrnb_in_init); |