| /* |
| ** Copyright (c) 2019, The Linux Foundation. All rights reserved. |
| ** Copyright (c) 2022 Qualcomm Innovation Center, Inc. All rights reserved. |
| ** |
| ** Redistribution and use in source and binary forms, with or without |
| ** modification, are permitted provided that the following conditions are |
| ** met: |
| ** * Redistributions of source code must retain the above copyright |
| ** notice, this list of conditions and the following disclaimer. |
| ** * Redistributions in binary form must reproduce the above |
| ** copyright notice, this list of conditions and the following |
| ** disclaimer in the documentation and/or other materials provided |
| ** with the distribution. |
| ** * Neither the name of The Linux Foundation nor the names of its |
| ** contributors may be used to endorse or promote products derived |
| ** from this software without specific prior written permission. |
| ** |
| ** THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED |
| ** WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF |
| ** MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT |
| ** ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS |
| ** BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| ** CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| ** SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR |
| ** BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, |
| ** WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE |
| ** OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN |
| ** IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| **/ |
| |
| #include <tinyalsa/asoundlib.h> |
| #include <stdio.h> |
| #include <stdbool.h> |
| #include <stdlib.h> |
| #include <stdint.h> |
| #include <string.h> |
| #include <signal.h> |
| #include <math.h> |
| #include <unistd.h> |
| #include <time.h> |
| #include "agmmixer.h" |
| |
| static int close_f = 0; |
| |
| void sigint_handler(int sig) |
| { |
| close_f = 1; |
| } |
| |
| void play_loopback(unsigned int card, unsigned int p_device, unsigned int c_device, unsigned int channels, |
| unsigned int rate, enum pcm_format format, struct device_config *cap_config, |
| struct device_config *p_config, unsigned int period_size, |
| unsigned int period_count, unsigned int play_cap_time, char* capture_intf, |
| char* play_intf, unsigned int pdkv, unsigned int cdkv, unsigned int stream_kv, |
| unsigned int do_loopback); |
| |
| void usage() |
| { |
| printf(" Usage: %s [-D card] [-P Hostless Playback device] [-C Hostless Capture device] [-p period_size]\n" |
| " [-n n_periods] [-c channels] [-r rate] [-b bits] [-T playback/capture time ]\n" |
| " [-i capture intf] [-o playback intf]\n" |
| " [-cdkv capture_device_kv] [-pdkv playback_device_kv] [-skv stream_kv]\n" |
| " Used to enable 'hostless' mode for audio devices with a DSP back-end.\n" |
| " Alternatively, specify '-l' for loopback mode: this program will read\n" |
| " from the capture device and write to the playback device.\n"); |
| } |
| |
| int main(int argc, char **argv) |
| { |
| unsigned int card = 100; |
| unsigned int p_device = 1; |
| unsigned int c_device = 0; |
| unsigned int period_size = 1024; |
| unsigned int period_count = 4; |
| unsigned int bits = 16; |
| unsigned int num_channels = 2; |
| unsigned int sample_rate = 48000; |
| unsigned int play_cap_time = 10; |
| char* c_intf_name = NULL; |
| char* p_intf_name = NULL; |
| unsigned int do_loopback = 0; |
| enum pcm_format format; |
| struct device_config capture_config; |
| struct device_config play_config; |
| unsigned int c_device_kv = 0; |
| unsigned int p_device_kv = 0; |
| unsigned int stream_kv = 0; |
| unsigned int ret = 0; |
| |
| if (argc < 2) { |
| usage(); |
| return 1; |
| } |
| |
| /* parse command line arguments */ |
| argv += 1; |
| while (*argv) { |
| if (strcmp(*argv, "-P") == 0) { |
| argv++; |
| if (*argv) |
| p_device = atoi(*argv); |
| } else if (strcmp(*argv, "-C") == 0) { |
| argv++; |
| if (*argv) |
| c_device = atoi(*argv); |
| } else if (strcmp(*argv, "-p") == 0) { |
| argv++; |
| if (*argv) |
| period_size = atoi(*argv); |
| } else if (strcmp(*argv, "-n") == 0) { |
| argv++; |
| if (*argv) |
| period_count = atoi(*argv); |
| } else if (strcmp(*argv, "-c") == 0) { |
| argv++; |
| if (*argv) |
| num_channels = atoi(*argv); |
| } else if (strcmp(*argv, "-r") == 0) { |
| argv++; |
| if (*argv) |
| sample_rate = atoi(*argv); |
| } else if (strcmp(*argv, "-b") == 0) { |
| argv++; |
| if (*argv) |
| bits = atoi(*argv); |
| } else if (strcmp(*argv, "-T") == 0) { |
| argv++; |
| if (*argv) |
| play_cap_time = atoi(*argv); |
| } else if (strcmp(*argv, "-D") == 0) { |
| argv++; |
| if (*argv) |
| card = atoi(*argv); |
| } else if (strcmp(*argv, "-i") == 0) { |
| argv++; |
| if (*argv) |
| c_intf_name = *argv; |
| } else if (strcmp(*argv, "-o") == 0) { |
| argv++; |
| if (*argv) |
| p_intf_name = *argv; |
| } else if (strcmp(*argv, "-l") == 0) { |
| do_loopback = 1; |
| } else if (strcmp(*argv, "-skv") == 0) { |
| argv++; |
| if (*argv) |
| stream_kv = convert_char_to_hex(*argv); |
| } else if (strcmp(*argv, "-cdkv") == 0) { |
| argv++; |
| if (*argv) |
| c_device_kv = convert_char_to_hex(*argv); |
| } else if (strcmp(*argv, "-pdkv") == 0) { |
| argv++; |
| if (*argv) |
| p_device_kv = convert_char_to_hex(*argv); |
| } else if (strcmp(*argv, "-help") == 0) { |
| usage(); |
| } |
| |
| if (*argv) |
| argv++; |
| } |
| |
| ret = get_device_media_config(BACKEND_CONF_FILE, c_intf_name, &capture_config); |
| if (ret) { |
| printf("Invalid input, assigning default values for : %s\n", c_intf_name); |
| capture_config.rate = sample_rate; |
| capture_config.bits = bits; |
| capture_config.ch = num_channels; |
| } |
| |
| ret = get_device_media_config(BACKEND_CONF_FILE, p_intf_name, &play_config); |
| if (ret) { |
| printf("Invalid input, assigning default values for : %s\n", p_intf_name); |
| play_config.rate = sample_rate; |
| play_config.bits = bits; |
| play_config.ch = num_channels; |
| } |
| |
| switch (bits) { |
| case 32: |
| format = PCM_FORMAT_S32_LE; |
| break; |
| case 24: |
| format = PCM_FORMAT_S24_LE; |
| break; |
| case 16: |
| format = PCM_FORMAT_S16_LE; |
| break; |
| default: |
| printf("%u bits is not supported.\n", bits); |
| return 1; |
| } |
| play_loopback(card, p_device, c_device, num_channels, sample_rate, format, &capture_config, &play_config, period_size, |
| period_count, play_cap_time, c_intf_name, p_intf_name, p_device_kv, |
| c_device_kv, stream_kv, do_loopback); |
| |
| return 0; |
| } |
| |
| void play_loopback(unsigned int card, unsigned int p_device, unsigned int c_device, unsigned int channels, |
| unsigned int rate, enum pcm_format format, struct device_config *cap_config, |
| struct device_config *p_config, unsigned int period_size, |
| unsigned int period_count, unsigned int play_cap_time, char* capture_intf, |
| char* play_intf, unsigned int pdkv, unsigned int cdkv, unsigned int stream_kv, |
| unsigned int do_loopback) |
| { |
| struct pcm_config config; |
| struct pcm *p_pcm, *c_pcm; |
| struct mixer *mixer; |
| char *buffer = NULL; |
| char *p_intf_name = play_intf; |
| char *c_intf_name = capture_intf; |
| unsigned int size; |
| unsigned int bytes_read = 0; |
| unsigned int frames = 0, ret = 0, miid = 0; |
| struct timespec end; |
| struct timespec now; |
| struct group_config grp_config; |
| stream_kv = stream_kv ? stream_kv : PCM_RX_LOOPBACK; |
| |
| if (!cap_config || !p_config || !capture_intf || !play_intf) { |
| printf("%s: %d: Invalid arguments.\n", __func__, __LINE__); |
| return; |
| } |
| |
| memset(&config, 0, sizeof(config)); |
| config.channels = channels; |
| config.rate = rate; |
| config.period_size = period_size; |
| config.period_count = period_count; |
| config.format = format; |
| config.start_threshold = 0; |
| config.stop_threshold = 0; |
| config.silence_threshold = 0; |
| |
| mixer = mixer_open(card); |
| if (!mixer) { |
| printf("Failed to open mixer\n"); |
| return; |
| } |
| |
| /* set device/audio_intf media config mixer control */ |
| if (set_agm_device_media_config(mixer, p_config->ch, p_config->rate, |
| p_config->bits, p_intf_name)) { |
| printf("Failed to set playback device media config\n"); |
| goto err_close_mixer; |
| } |
| |
| if (set_agm_device_media_config(mixer, cap_config->ch, cap_config->rate, |
| cap_config->bits, c_intf_name)) { |
| printf("Failed to set capture device media config\n"); |
| goto err_close_mixer; |
| } |
| |
| /* set audio interface metadata mixer control */ |
| if (set_agm_audio_intf_metadata(mixer, c_intf_name, cdkv, CAPTURE, rate, cap_config->bits, stream_kv)) { |
| printf("Failed to set capture device metadata\n"); |
| goto err_close_mixer; |
| } |
| |
| if (set_agm_audio_intf_metadata(mixer, p_intf_name, pdkv, PLAYBACK, rate, p_config->bits, stream_kv)) { |
| printf("Failed to set playback device metadata\n"); |
| goto err_close_mixer; |
| } |
| |
| if (set_agm_stream_metadata(mixer, c_device, stream_kv, LOOPBACK, STREAM_PCM, |
| 0)) { |
| printf("Failed to capture stream metadata\n"); |
| goto err_close_mixer; |
| } |
| |
| /* Note: No common metadata as of now*/ |
| |
| /* connect pcm stream to audio intf */ |
| if (connect_agm_audio_intf_to_stream(mixer, p_device, p_intf_name, STREAM_PCM, true)) { |
| printf("Failed to connect playback pcm to audio interface\n"); |
| goto err_close_mixer; |
| } |
| |
| if (connect_agm_audio_intf_to_stream(mixer, c_device, c_intf_name, STREAM_PCM, true)) { |
| printf("Failed to connect capture pcm to audio interface\n"); |
| connect_agm_audio_intf_to_stream(mixer, p_device, p_intf_name, STREAM_PCM, false); |
| goto err_close_mixer; |
| } |
| |
| if (connect_play_pcm_to_cap_pcm(mixer, p_device, c_device)) { |
| printf("Failed to connect capture pcm to audio interface\n"); |
| goto err_disconnect; |
| } |
| |
| if (strstr(p_intf_name, "VIRT-")) { |
| if (get_group_device_info(BACKEND_CONF_FILE, p_intf_name, &grp_config)) |
| goto err_disconnect; |
| |
| if (set_agm_group_device_config(mixer, p_intf_name, &grp_config)) { |
| printf("Failed to set grp device config\n"); |
| goto err_disconnect; |
| } |
| } |
| ret = agm_mixer_get_miid (mixer, p_device, p_intf_name, STREAM_PCM, PER_STREAM_PER_DEVICE_MFC, &miid); |
| if (ret) { |
| printf("MFC not present for this graph\n"); |
| } else { |
| if (configure_mfc(mixer, p_device, p_intf_name, PER_STREAM_PER_DEVICE_MFC, |
| STREAM_PCM, p_config->rate, p_config->ch, |
| p_config->bits, miid)) { |
| printf("Failed to configure pspd mfc\n"); |
| goto err_disconnect; |
| } |
| } |
| |
| p_pcm = pcm_open(card, p_device, PCM_OUT, &config); |
| if (!p_pcm || !pcm_is_ready(p_pcm)) { |
| printf("Unable to open playback PCM device (%s)\n", |
| pcm_get_error(p_pcm)); |
| goto err_disconnect; |
| } |
| if (strstr(p_intf_name, "VIRT-") || (pdkv == SPEAKER) || (pdkv == HANDSET)) { |
| if (set_agm_group_mux_config(mixer, p_device, &grp_config, p_intf_name, p_config->ch)) { |
| printf("Failed to set mux config\n"); |
| goto err_close_p_pcm; |
| } |
| } |
| |
| if (pcm_start(p_pcm) < 0) { |
| printf("start error"); |
| goto err_close_p_pcm; |
| } |
| |
| c_pcm = pcm_open(card, c_device, PCM_IN, &config); |
| if (!c_pcm || !pcm_is_ready(c_pcm)) { |
| printf("Unable to open playback PCM device (%s)\n", |
| pcm_get_error(c_pcm)); |
| goto err_close_p_pcm; |
| } |
| |
| if (pcm_start(c_pcm) < 0) { |
| printf("start error"); |
| goto err_close_c_pcm; |
| } |
| |
| if (do_loopback) { |
| size = pcm_frames_to_bytes(c_pcm, pcm_get_buffer_size(c_pcm)); |
| buffer = malloc(size); |
| if (!buffer) { |
| printf("Unable to allocate %d bytes\n", size); |
| goto err_close_c_pcm; |
| } |
| } |
| |
| clock_gettime(CLOCK_MONOTONIC, &end); |
| end.tv_sec += play_cap_time; |
| while (1) { |
| if (close_f) |
| break; |
| if (do_loopback) { |
| if (pcm_read(c_pcm, buffer, size)) { |
| printf("Unable to read from PCM capture device %u (%s)\n", |
| c_device, pcm_get_error(c_pcm)); |
| break; |
| } |
| if (pcm_write(p_pcm, buffer, size)) { |
| printf("Unable to write to PCM playback device %u (%s)\n", |
| p_device, pcm_get_error(p_pcm)); |
| break; |
| } |
| } else { |
| usleep(100000); |
| } |
| |
| if (play_cap_time) { |
| clock_gettime(CLOCK_MONOTONIC, &now); |
| if (now.tv_sec > end.tv_sec || |
| (now.tv_sec == end.tv_sec && now.tv_nsec >= end.tv_nsec)) |
| break; |
| } |
| } |
| connect_play_pcm_to_cap_pcm(mixer, -1, c_device); |
| err_close_c_pcm: |
| pcm_close(c_pcm); |
| err_close_p_pcm: |
| if (buffer) |
| free(buffer); |
| pcm_close(p_pcm); |
| err_disconnect: |
| connect_agm_audio_intf_to_stream(mixer, p_device, p_intf_name, STREAM_PCM, false); |
| connect_agm_audio_intf_to_stream(mixer, c_device, c_intf_name, STREAM_PCM, false); |
| err_close_mixer: |
| mixer_close(mixer); |
| } |