M7350/external/bluetooth/bluez/android/client/if-sco.c
2024-09-09 08:57:42 +00:00

522 lines
12 KiB
C

/*
* Copyright (C) 2014 Intel Corporation
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*
*/
#include "if-main.h"
#include "../hal-utils.h"
#include "pthread.h"
#include "unistd.h"
#include <math.h>
audio_hw_device_t *if_audio_sco = NULL;
static struct audio_stream_out *stream_out = NULL;
static size_t buffer_size = 0;
static pthread_t play_thread = 0;
static pthread_mutex_t outstream_mutex = PTHREAD_MUTEX_INITIALIZER;
static pthread_mutex_t state_mutex = PTHREAD_MUTEX_INITIALIZER;
enum state {
STATE_STOPPED,
STATE_STOPPING,
STATE_PLAYING,
STATE_SUSPENDED,
STATE_MAX
};
SINTMAP(audio_channel_mask_t, -1, "(AUDIO_CHANNEL_INVALID)")
DELEMENT(AUDIO_CHANNEL_OUT_FRONT_LEFT),
DELEMENT(AUDIO_CHANNEL_OUT_FRONT_RIGHT),
DELEMENT(AUDIO_CHANNEL_OUT_FRONT_CENTER),
DELEMENT(AUDIO_CHANNEL_OUT_LOW_FREQUENCY),
DELEMENT(AUDIO_CHANNEL_OUT_BACK_LEFT),
DELEMENT(AUDIO_CHANNEL_OUT_BACK_RIGHT),
DELEMENT(AUDIO_CHANNEL_OUT_FRONT_LEFT_OF_CENTER),
DELEMENT(AUDIO_CHANNEL_OUT_FRONT_RIGHT_OF_CENTER),
DELEMENT(AUDIO_CHANNEL_OUT_BACK_CENTER),
DELEMENT(AUDIO_CHANNEL_OUT_SIDE_LEFT),
DELEMENT(AUDIO_CHANNEL_OUT_SIDE_RIGHT),
DELEMENT(AUDIO_CHANNEL_OUT_TOP_CENTER),
DELEMENT(AUDIO_CHANNEL_OUT_TOP_FRONT_LEFT),
DELEMENT(AUDIO_CHANNEL_OUT_TOP_FRONT_CENTER),
DELEMENT(AUDIO_CHANNEL_OUT_TOP_FRONT_RIGHT),
DELEMENT(AUDIO_CHANNEL_OUT_TOP_BACK_LEFT),
DELEMENT(AUDIO_CHANNEL_OUT_TOP_BACK_CENTER),
DELEMENT(AUDIO_CHANNEL_OUT_TOP_BACK_RIGHT),
DELEMENT(AUDIO_CHANNEL_OUT_MONO),
DELEMENT(AUDIO_CHANNEL_OUT_STEREO),
DELEMENT(AUDIO_CHANNEL_OUT_QUAD),
DELEMENT(AUDIO_CHANNEL_OUT_SURROUND),
DELEMENT(AUDIO_CHANNEL_OUT_5POINT1),
DELEMENT(AUDIO_CHANNEL_OUT_7POINT1),
DELEMENT(AUDIO_CHANNEL_OUT_ALL),
DELEMENT(AUDIO_CHANNEL_OUT_FRONT_LEFT),
DELEMENT(AUDIO_CHANNEL_OUT_FRONT_LEFT),
DELEMENT(AUDIO_CHANNEL_OUT_FRONT_LEFT),
DELEMENT(AUDIO_CHANNEL_OUT_FRONT_LEFT),
DELEMENT(AUDIO_CHANNEL_OUT_FRONT_LEFT),
ENDMAP
SINTMAP(audio_format_t, -1, "(AUDIO_FORMAT_INVALID)")
DELEMENT(AUDIO_FORMAT_DEFAULT),
DELEMENT(AUDIO_FORMAT_PCM),
DELEMENT(AUDIO_FORMAT_MP3),
DELEMENT(AUDIO_FORMAT_AMR_NB),
DELEMENT(AUDIO_FORMAT_AMR_WB),
DELEMENT(AUDIO_FORMAT_AAC),
DELEMENT(AUDIO_FORMAT_HE_AAC_V1),
DELEMENT(AUDIO_FORMAT_HE_AAC_V2),
DELEMENT(AUDIO_FORMAT_VORBIS),
DELEMENT(AUDIO_FORMAT_MAIN_MASK),
DELEMENT(AUDIO_FORMAT_SUB_MASK),
DELEMENT(AUDIO_FORMAT_PCM_16_BIT),
DELEMENT(AUDIO_FORMAT_PCM_8_BIT),
DELEMENT(AUDIO_FORMAT_PCM_32_BIT),
DELEMENT(AUDIO_FORMAT_PCM_8_24_BIT),
ENDMAP
static int current_state = STATE_STOPPED;
#define SAMPLERATE 44100
static short sample[SAMPLERATE];
static uint16_t sample_pos;
static void init_p(int argc, const char **argv)
{
int err;
const hw_module_t *module;
audio_hw_device_t *device;
err = hw_get_module_by_class(AUDIO_HARDWARE_MODULE_ID, "sco", &module);
if (err) {
haltest_error("hw_get_module_by_class returned %d\n", err);
return;
}
err = audio_hw_device_open(module, &device);
if (err) {
haltest_error("audio_hw_device_open returned %d\n", err);
return;
}
if_audio_sco = device;
}
static int feed_from_file(short *buffer, void *data)
{
FILE *in = data;
return fread(buffer, buffer_size, 1, in);
}
static int feed_from_generator(short *buffer, void *data)
{
size_t i = 0;
float volume = 0.5;
float *freq = data;
float f = 1;
if (freq)
f = *freq;
/* buffer_size is in bytes but we are using buffer of shorts (2 bytes)*/
for (i = 0; i < buffer_size / sizeof(*buffer) - 1;) {
if (sample_pos >= SAMPLERATE)
sample_pos = sample_pos % SAMPLERATE;
/* Use the same sample for both channels */
buffer[i++] = sample[sample_pos] * volume;
buffer[i++] = sample[sample_pos] * volume;
sample_pos += f;
}
return buffer_size;
}
static void prepare_sample(void)
{
int x;
double s;
haltest_info("Preparing audio sample...\n");
for (x = 0; x < SAMPLERATE; x++) {
/* prepare sinusoidal 1Hz sample */
s = (2.0 * 3.14159) * ((double)x / SAMPLERATE);
s = sin(s);
/* remap <-1, 1> to signed 16bit PCM range */
sample[x] = s * 32767;
}
sample_pos = 0;
}
static void *playback_thread(void *data)
{
int (*filbuff_cb) (short*, void*);
short buffer[buffer_size / sizeof(short)];
size_t len = 0;
ssize_t w_len = 0;
FILE *in = data;
void *cb_data = NULL;
float freq = 440.0;
/* Use file or fall back to generator */
if (in) {
filbuff_cb = feed_from_file;
cb_data = in;
} else {
prepare_sample();
filbuff_cb = feed_from_generator;
cb_data = &freq;
}
pthread_mutex_lock(&state_mutex);
current_state = STATE_PLAYING;
pthread_mutex_unlock(&state_mutex);
do {
pthread_mutex_lock(&state_mutex);
if (current_state == STATE_STOPPING) {
haltest_info("Detected stopping\n");
pthread_mutex_unlock(&state_mutex);
break;
} else if (current_state == STATE_SUSPENDED) {
pthread_mutex_unlock(&state_mutex);
usleep(500);
continue;
}
pthread_mutex_unlock(&state_mutex);
len = filbuff_cb(buffer, cb_data);
pthread_mutex_lock(&outstream_mutex);
if (!stream_out) {
pthread_mutex_unlock(&outstream_mutex);
break;
}
w_len = stream_out->write(stream_out, buffer, buffer_size);
pthread_mutex_unlock(&outstream_mutex);
} while (len && w_len > 0);
if (in)
fclose(in);
pthread_mutex_lock(&state_mutex);
current_state = STATE_STOPPED;
pthread_mutex_unlock(&state_mutex);
haltest_info("Done playing.\n");
return NULL;
}
static void play_p(int argc, const char **argv)
{
const char *fname = NULL;
FILE *in = NULL;
RETURN_IF_NULL(if_audio_sco);
RETURN_IF_NULL(stream_out);
if (argc < 3) {
haltest_error("Invalid audio file path.\n");
haltest_info("Using sound generator.\n");
} else {
fname = argv[2];
in = fopen(fname, "r");
if (in == NULL) {
haltest_error("Cannot open file: %s\n", fname);
return;
}
haltest_info("Playing file: %s\n", fname);
}
if (buffer_size == 0) {
haltest_error("Invalid buffer size. Was stream_out opened?\n");
goto fail;
}
pthread_mutex_lock(&state_mutex);
if (current_state != STATE_STOPPED) {
haltest_error("Already playing or stream suspended!\n");
pthread_mutex_unlock(&state_mutex);
goto fail;
}
pthread_mutex_unlock(&state_mutex);
if (pthread_create(&play_thread, NULL, playback_thread, in) != 0) {
haltest_error("Cannot create playback thread!\n");
goto fail;
}
return;
fail:
if (in)
fclose(in);
}
static void stop_p(int argc, const char **argv)
{
pthread_mutex_lock(&state_mutex);
if (current_state == STATE_STOPPED || current_state == STATE_STOPPING) {
pthread_mutex_unlock(&state_mutex);
return;
}
current_state = STATE_STOPPING;
pthread_mutex_unlock(&state_mutex);
pthread_mutex_lock(&outstream_mutex);
stream_out->common.standby(&stream_out->common);
pthread_mutex_unlock(&outstream_mutex);
haltest_info("Ended %s\n", __func__);
}
static void open_output_stream_p(int argc, const char **argv)
{
int err;
RETURN_IF_NULL(if_audio_sco);
pthread_mutex_lock(&state_mutex);
if (current_state == STATE_PLAYING) {
haltest_error("Already playing!\n");
pthread_mutex_unlock(&state_mutex);
return;
}
pthread_mutex_unlock(&state_mutex);
err = if_audio_sco->open_output_stream(if_audio_sco,
0,
AUDIO_DEVICE_OUT_ALL_SCO,
AUDIO_OUTPUT_FLAG_NONE,
NULL,
&stream_out);
if (err < 0) {
haltest_error("open output stream returned %d\n", err);
return;
}
buffer_size = stream_out->common.get_buffer_size(&stream_out->common);
if (buffer_size == 0)
haltest_error("Invalid buffer size received!\n");
else
haltest_info("Using buffer size: %zu\n", buffer_size);
}
static void close_output_stream_p(int argc, const char **argv)
{
RETURN_IF_NULL(if_audio_sco);
RETURN_IF_NULL(stream_out);
stop_p(argc, argv);
haltest_info("Waiting for playback thread...\n");
pthread_join(play_thread, NULL);
if_audio_sco->close_output_stream(if_audio_sco, stream_out);
stream_out = NULL;
buffer_size = 0;
}
static void cleanup_p(int argc, const char **argv)
{
int err;
RETURN_IF_NULL(if_audio_sco);
pthread_mutex_lock(&state_mutex);
if (current_state != STATE_STOPPED) {
pthread_mutex_unlock(&state_mutex);
close_output_stream_p(0, NULL);
} else {
pthread_mutex_unlock(&state_mutex);
}
err = audio_hw_device_close(if_audio_sco);
if (err < 0) {
haltest_error("audio_hw_device_close returned %d\n", err);
return;
}
if_audio_sco = NULL;
}
static void suspend_p(int argc, const char **argv)
{
RETURN_IF_NULL(if_audio_sco);
RETURN_IF_NULL(stream_out);
pthread_mutex_lock(&state_mutex);
if (current_state != STATE_PLAYING) {
pthread_mutex_unlock(&state_mutex);
return;
}
current_state = STATE_SUSPENDED;
pthread_mutex_unlock(&state_mutex);
pthread_mutex_lock(&outstream_mutex);
stream_out->common.standby(&stream_out->common);
pthread_mutex_unlock(&outstream_mutex);
}
static void resume_p(int argc, const char **argv)
{
RETURN_IF_NULL(if_audio_sco);
RETURN_IF_NULL(stream_out);
pthread_mutex_lock(&state_mutex);
if (current_state == STATE_SUSPENDED)
current_state = STATE_PLAYING;
pthread_mutex_unlock(&state_mutex);
}
static void get_latency_p(int argc, const char **argv)
{
RETURN_IF_NULL(if_audio_sco);
RETURN_IF_NULL(stream_out);
haltest_info("Output audio stream latency: %d\n",
stream_out->get_latency(stream_out));
}
static void get_buffer_size_p(int argc, const char **argv)
{
RETURN_IF_NULL(if_audio_sco);
RETURN_IF_NULL(stream_out);
haltest_info("Current output buffer size: %zu\n",
stream_out->common.get_buffer_size(&stream_out->common));
}
static void get_channels_p(int argc, const char **argv)
{
audio_channel_mask_t channels;
RETURN_IF_NULL(if_audio_sco);
RETURN_IF_NULL(stream_out);
channels = stream_out->common.get_channels(&stream_out->common);
haltest_info("Channels: %s\n", audio_channel_mask_t2str(channels));
}
static void get_format_p(int argc, const char **argv)
{
audio_format_t format;
RETURN_IF_NULL(if_audio_sco);
RETURN_IF_NULL(stream_out);
format = stream_out->common.get_format(&stream_out->common);
haltest_info("Format: %s\n", audio_format_t2str(format));
}
static void get_sample_rate_p(int argc, const char **argv)
{
RETURN_IF_NULL(if_audio_sco);
RETURN_IF_NULL(stream_out);
haltest_info("Current sample rate: %d\n",
stream_out->common.get_sample_rate(&stream_out->common));
}
static void get_parameters_p(int argc, const char **argv)
{
const char *keystr;
RETURN_IF_NULL(if_audio_sco);
RETURN_IF_NULL(stream_out);
if (argc < 3) {
haltest_info("No keys given.\n");
keystr = "";
} else {
keystr = argv[2];
}
haltest_info("Current parameters: %s\n",
stream_out->common.get_parameters(&stream_out->common,
keystr));
}
static void set_parameters_p(int argc, const char **argv)
{
RETURN_IF_NULL(if_audio_sco);
RETURN_IF_NULL(stream_out);
if (argc < 3) {
haltest_error("No key=value; pairs given.\n");
return;
}
stream_out->common.set_parameters(&stream_out->common, argv[2]);
}
static void set_sample_rate_p(int argc, const char **argv)
{
RETURN_IF_NULL(if_audio_sco);
RETURN_IF_NULL(stream_out);
if (argc < 3)
return;
stream_out->common.set_sample_rate(&stream_out->common, atoi(argv[2]));
}
static void init_check_p(int argc, const char **argv)
{
RETURN_IF_NULL(if_audio_sco);
haltest_info("Init check result: %d\n",
if_audio_sco->init_check(if_audio_sco));
}
static struct method methods[] = {
STD_METHOD(init),
STD_METHOD(cleanup),
STD_METHOD(open_output_stream),
STD_METHOD(close_output_stream),
STD_METHODH(play, "<path to pcm file>"),
STD_METHOD(stop),
STD_METHOD(suspend),
STD_METHOD(resume),
STD_METHOD(get_latency),
STD_METHOD(get_buffer_size),
STD_METHOD(get_channels),
STD_METHOD(get_format),
STD_METHOD(get_sample_rate),
STD_METHODH(get_parameters, "<closing>"),
STD_METHODH(set_parameters, "<closing=value>"),
STD_METHODH(set_sample_rate, "<sample rate>"),
STD_METHOD(init_check),
END_METHOD
};
const struct interface sco_if = {
.name = "sco",
.methods = methods
};