| /**************************************************************************** |
| * drivers/audio/wm8776.c |
| * |
| * Licensed to the Apache Software Foundation (ASF) under one or more |
| * contributor license agreements. See the NOTICE file distributed with |
| * this work for additional information regarding copyright ownership. The |
| * ASF licenses this file to you 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. |
| * |
| ****************************************************************************/ |
| |
| /**************************************************************************** |
| * Included Files |
| ****************************************************************************/ |
| |
| #include <nuttx/config.h> |
| |
| #include <sys/types.h> |
| #include <sys/ioctl.h> |
| |
| #include <inttypes.h> |
| #include <stdint.h> |
| #include <stdio.h> |
| #include <fcntl.h> |
| #include <string.h> |
| #include <assert.h> |
| #include <errno.h> |
| #include <fixedmath.h> |
| #include <debug.h> |
| |
| #include <nuttx/spinlock.h> |
| #include <nuttx/kmalloc.h> |
| #include <nuttx/queue.h> |
| #include <nuttx/semaphore.h> |
| #include <nuttx/clock.h> |
| #include <nuttx/wqueue.h> |
| #include <nuttx/i2c/i2c_master.h> |
| #include <nuttx/fs/fs.h> |
| #include <nuttx/fs/ioctl.h> |
| #include <nuttx/audio/i2s.h> |
| #include <nuttx/audio/audio.h> |
| #include <nuttx/audio/wm8776.h> |
| |
| #include "wm8776.h" |
| |
| /**************************************************************************** |
| * Pre-processor Definitions |
| ****************************************************************************/ |
| |
| static void wm8776_writereg(FAR struct wm8776_dev_s *priv, |
| uint8_t regaddr, uint16_t regval); |
| static int wm8776_getcaps(FAR struct audio_lowerhalf_s *dev, int type, |
| FAR struct audio_caps_s *caps); |
| #ifdef CONFIG_AUDIO_MULTI_SESSION |
| static int wm8776_configure(FAR struct audio_lowerhalf_s *dev, |
| FAR void *session, FAR const struct audio_caps_s *caps); |
| #else |
| static int wm8776_configure(FAR struct audio_lowerhalf_s *dev, |
| FAR const struct audio_caps_s *caps); |
| #endif |
| static int wm8776_shutdown(FAR struct audio_lowerhalf_s *dev); |
| static void wm8776_senddone(FAR struct i2s_dev_s *i2s, |
| FAR struct ap_buffer_s *apb, FAR void *arg, int result); |
| static void wm8776_returnbuffers(FAR struct wm8776_dev_s *priv); |
| static int wm8776_sendbuffer(FAR struct wm8776_dev_s *priv); |
| |
| #ifdef CONFIG_AUDIO_MULTI_SESSION |
| static int wm8776_start(FAR struct audio_lowerhalf_s *dev, |
| FAR void *session); |
| #else |
| static int wm8776_start(FAR struct audio_lowerhalf_s *dev); |
| #endif |
| #ifndef CONFIG_AUDIO_EXCLUDE_STOP |
| #ifdef CONFIG_AUDIO_MULTI_SESSION |
| static int wm8776_stop(FAR struct audio_lowerhalf_s *dev, |
| FAR void *session); |
| #else |
| static int wm8776_stop(FAR struct audio_lowerhalf_s *dev); |
| #endif |
| #endif |
| #ifndef CONFIG_AUDIO_EXCLUDE_PAUSE_RESUME |
| #ifdef CONFIG_AUDIO_MULTI_SESSION |
| static int wm8776_pause(FAR struct audio_lowerhalf_s *dev, |
| FAR void *session); |
| static int wm8776_resume(FAR struct audio_lowerhalf_s *dev, |
| FAR void *session); |
| #else |
| static int wm8776_pause(FAR struct audio_lowerhalf_s *dev); |
| static int wm8776_resume(FAR struct audio_lowerhalf_s *dev); |
| #endif |
| #endif |
| static int wm8776_enqueuebuffer(FAR struct audio_lowerhalf_s *dev, |
| FAR struct ap_buffer_s *apb); |
| static int wm8776_cancelbuffer(FAR struct audio_lowerhalf_s *dev, |
| FAR struct ap_buffer_s *apb); |
| static int wm8776_ioctl(FAR struct audio_lowerhalf_s *dev, int cmd, |
| unsigned long arg); |
| #ifdef CONFIG_AUDIO_MULTI_SESSION |
| static int wm8776_reserve(FAR struct audio_lowerhalf_s *dev, |
| FAR void **session); |
| #else |
| static int wm8776_reserve(FAR struct audio_lowerhalf_s *dev); |
| #endif |
| #ifdef CONFIG_AUDIO_MULTI_SESSION |
| static int wm8776_release(FAR struct audio_lowerhalf_s *dev, |
| FAR void *session); |
| #else |
| static int wm8776_release(FAR struct audio_lowerhalf_s *dev); |
| #endif |
| |
| static void *wm8776_workerthread(pthread_addr_t pvarg); |
| |
| /* Initialization */ |
| |
| static void wm8776_audio_output(FAR struct wm8776_dev_s *priv); |
| #if 0 /* Not used */ |
| static void wm8776_audio_input(FAR struct wm8776_dev_s *priv); |
| #endif |
| static void wm8776_hw_reset(FAR struct wm8776_dev_s *priv); |
| |
| /**************************************************************************** |
| * Private Data |
| ****************************************************************************/ |
| |
| static const struct audio_ops_s g_audioops = |
| { |
| wm8776_getcaps, /* getcaps */ |
| wm8776_configure, /* configure */ |
| wm8776_shutdown, /* shutdown */ |
| wm8776_start, /* start */ |
| #ifndef CONFIG_AUDIO_EXCLUDE_STOP |
| wm8776_stop, /* stop */ |
| #endif |
| #ifndef CONFIG_AUDIO_EXCLUDE_PAUSE_RESUME |
| wm8776_pause, /* pause */ |
| wm8776_resume, /* resume */ |
| #endif |
| NULL, /* allocbuffer */ |
| NULL, /* freebuffer */ |
| wm8776_enqueuebuffer, /* enqueue_buffer */ |
| wm8776_cancelbuffer, /* cancel_buffer */ |
| wm8776_ioctl, /* ioctl */ |
| NULL, /* read */ |
| NULL, /* write */ |
| wm8776_reserve, /* reserve */ |
| wm8776_release /* release */ |
| }; |
| |
| /**************************************************************************** |
| * Name: wm8776_writereg |
| * |
| * Description: |
| * Write the specified 16-bit register to the WM8776 device. |
| * |
| ****************************************************************************/ |
| |
| static void wm8776_writereg(FAR struct wm8776_dev_s *priv, |
| uint8_t regaddr, |
| uint16_t regval) |
| { |
| struct i2c_config_s config; |
| uint8_t data[2]; |
| int ret; |
| |
| /* Setup up the I2C configuration */ |
| |
| config.frequency = priv->lower->frequency; |
| config.address = priv->lower->address; |
| config.addrlen = 7; |
| |
| /* Set up the data to write */ |
| |
| data[0] = (regaddr << 1) + ((regval >> 8) & 0x1); |
| data[1] = (regval & 0xff); |
| |
| ret = i2c_write(priv->i2c, &config, data, sizeof(data)); |
| if (ret < 0) |
| { |
| auderr("ERROR: I2C_TRANSFER failed: %d\n", ret); |
| } |
| } |
| |
| /**************************************************************************** |
| * Name: wm8776_setvolume |
| * |
| * Description: |
| * Set the right and left volume values in the WM8776 device based on the |
| * current volume and balance settings. |
| * |
| ****************************************************************************/ |
| |
| #ifndef CONFIG_AUDIO_EXCLUDE_VOLUME |
| static void wm8776_setvolume(FAR struct wm8776_dev_s *priv, uint16_t volume, |
| bool mute) |
| { |
| uint16_t regval; |
| uint16_t tmp_vol; |
| |
| /* TODO: balance */ |
| |
| if (mute) |
| { |
| tmp_vol = 0; |
| } |
| else |
| { |
| tmp_vol = volume; |
| } |
| |
| /* limit the max vol */ |
| |
| if (tmp_vol > 0x69) |
| { |
| tmp_vol = 0x69; /* -10db */ |
| } |
| |
| regval = WM8776_UPDATE | WM8776_HPOUT_VOL(tmp_vol); |
| |
| wm8776_writereg(priv, WM8776_MASTER_ATT, regval); |
| |
| audinfo("volume=%d mute=%d tmp_vol=%d (regval=0x%x)\n", |
| volume, mute, tmp_vol, regval); |
| |
| /* Remember the volume level and mute settings */ |
| |
| priv->volume = volume; |
| priv->mute = mute; |
| } |
| #endif /* CONFIG_AUDIO_EXCLUDE_VOLUME */ |
| |
| /**************************************************************************** |
| * Name: wm8776_getcaps |
| * |
| * Description: |
| * Get the audio device capabilities |
| * |
| ****************************************************************************/ |
| |
| static int wm8776_getcaps(FAR struct audio_lowerhalf_s *dev, int type, |
| FAR struct audio_caps_s *caps) |
| { |
| /* Validate the structure */ |
| |
| DEBUGASSERT(caps && caps->ac_len >= sizeof(struct audio_caps_s)); |
| audinfo("type=%d ac_type=%d\n", type, caps->ac_type); |
| |
| /* Fill in the caller's structure based on requested info */ |
| |
| caps->ac_format.hw = 0; |
| caps->ac_controls.w = 0; |
| |
| switch (caps->ac_type) |
| { |
| /* Caller is querying for the types of units we support */ |
| |
| case AUDIO_TYPE_QUERY: |
| |
| /* Provide our overall capabilities. The interfacing software |
| * must then call us back for specific info for each capability. |
| */ |
| |
| caps->ac_channels = 2; /* Stereo output */ |
| |
| switch (caps->ac_subtype) |
| { |
| case AUDIO_TYPE_QUERY: |
| /* We don't decode any formats! Only something above us in |
| * the audio stream can perform decoding on our behalf. |
| */ |
| |
| /* The types of audio units we implement */ |
| |
| caps->ac_controls.b[0] = |
| AUDIO_TYPE_OUTPUT | AUDIO_TYPE_FEATURE | |
| AUDIO_TYPE_PROCESSING; |
| |
| break; |
| |
| default: |
| caps->ac_controls.b[0] = AUDIO_SUBFMT_END; |
| break; |
| } |
| |
| break; |
| |
| /* Provide capabilities of our OUTPUT unit */ |
| |
| case AUDIO_TYPE_OUTPUT: |
| |
| caps->ac_channels = 2; |
| |
| switch (caps->ac_subtype) |
| { |
| case AUDIO_TYPE_QUERY: |
| |
| /* Report the Sample rates we support */ |
| |
| caps->ac_controls.b[0] = AUDIO_SAMP_RATE_44K; |
| break; |
| |
| case AUDIO_FMT_MP3: |
| case AUDIO_FMT_WMA: |
| case AUDIO_FMT_PCM: |
| default: |
| break; |
| } |
| |
| break; |
| |
| /* All others we don't support */ |
| |
| default: |
| |
| /* Zero out the fields to indicate no support */ |
| |
| caps->ac_subtype = 0; |
| caps->ac_channels = 0; |
| |
| break; |
| } |
| |
| /* Return the length of the audio_caps_s struct for validation of |
| * proper Audio device type. |
| */ |
| |
| return caps->ac_len; |
| } |
| |
| /**************************************************************************** |
| * Name: wm8776_configure |
| * |
| * Description: |
| * Configure the audio device for the specified mode of operation. |
| * |
| ****************************************************************************/ |
| |
| #ifdef CONFIG_AUDIO_MULTI_SESSION |
| static int wm8776_configure(FAR struct audio_lowerhalf_s *dev, |
| FAR void *session, |
| FAR const struct audio_caps_s *caps) |
| #else |
| static int wm8776_configure(FAR struct audio_lowerhalf_s *dev, |
| FAR const struct audio_caps_s *caps) |
| #endif |
| { |
| FAR struct wm8776_dev_s *priv = (FAR struct wm8776_dev_s *)dev; |
| int ret = OK; |
| |
| DEBUGASSERT(priv != NULL && caps != NULL); |
| audinfo("ac_type: %d\n", caps->ac_type); |
| |
| /* Process the configure operation */ |
| |
| switch (caps->ac_type) |
| { |
| case AUDIO_TYPE_FEATURE: |
| audinfo(" AUDIO_TYPE_FEATURE\n"); |
| |
| /* Process based on Feature Unit */ |
| |
| switch (caps->ac_format.hw) |
| { |
| #ifndef CONFIG_AUDIO_EXCLUDE_VOLUME |
| case AUDIO_FU_VOLUME: |
| { |
| /* Set the volume */ |
| |
| uint16_t volume = caps->ac_controls.hw[0]; |
| audinfo(" Volume: %d\n", volume); |
| |
| if (volume >= 0 && volume <= 1000) |
| { |
| /* Scale the volume setting to the range {0x2f .. 0x79} */ |
| |
| wm8776_setvolume(priv, (0x4a * volume / 1000) + 0x2f, |
| priv->mute); |
| } |
| else |
| { |
| ret = -EDOM; |
| } |
| } |
| break; |
| #endif /* CONFIG_AUDIO_EXCLUDE_VOLUME */ |
| |
| default: |
| auderr(" ERROR: Unrecognized feature unit\n"); |
| ret = -ENOTTY; |
| break; |
| } |
| break; |
| |
| case AUDIO_TYPE_OUTPUT: |
| { |
| audinfo(" AUDIO_TYPE_OUTPUT:\n"); |
| audinfo(" Number of channels: %u\n", caps->ac_channels); |
| audinfo(" Sample rate: %u\n", caps->ac_controls.hw[0]); |
| audinfo(" Sample width: %u\n", caps->ac_controls.b[2]); |
| |
| /* Verify that all of the requested values are supported */ |
| |
| ret = -ERANGE; |
| if (caps->ac_channels != 1 && caps->ac_channels != 2) |
| { |
| auderr("ERROR: Unsupported number of channels: %d\n", |
| caps->ac_channels); |
| break; |
| } |
| |
| if (caps->ac_controls.b[2] != 8 && caps->ac_controls.b[2] != 16) |
| { |
| auderr("ERROR: Unsupported bits per sample: %d\n", |
| caps->ac_controls.b[2]); |
| break; |
| } |
| |
| /* Save the current stream configuration */ |
| |
| priv->samprate = caps->ac_controls.hw[0]; |
| priv->nchannels = caps->ac_channels; |
| priv->bpsamp = caps->ac_controls.b[2]; |
| |
| /* TODO : channels, bits per sample, bitrate */ |
| |
| ret = OK; |
| } |
| break; |
| |
| case AUDIO_TYPE_PROCESSING: |
| break; |
| } |
| |
| return ret; |
| } |
| |
| /**************************************************************************** |
| * Name: wm8776_shutdown |
| * |
| * Description: |
| * Shutdown the WM8776 chip and put it in the lowest power state possible. |
| * |
| ****************************************************************************/ |
| |
| static int wm8776_shutdown(FAR struct audio_lowerhalf_s *dev) |
| { |
| FAR struct wm8776_dev_s *priv = (FAR struct wm8776_dev_s *)dev; |
| |
| DEBUGASSERT(priv); |
| |
| /* Now issue a software reset. This puts all WM8776 registers back in |
| * their default state. |
| */ |
| |
| wm8776_hw_reset(priv); |
| return OK; |
| } |
| |
| /**************************************************************************** |
| * Name: wm8776_senddone |
| * |
| * Description: |
| * This is the I2S callback function that is invoked when the transfer |
| * completes. |
| * |
| ****************************************************************************/ |
| |
| static void wm8776_senddone(FAR struct i2s_dev_s *i2s, |
| FAR struct ap_buffer_s *apb, FAR void *arg, |
| int result) |
| { |
| FAR struct wm8776_dev_s *priv = (FAR struct wm8776_dev_s *)arg; |
| struct audio_msg_s msg; |
| irqstate_t flags; |
| int ret; |
| |
| DEBUGASSERT(i2s && priv && priv->running && apb); |
| audinfo("apb=%p inflight=%d result=%d\n", apb, priv->inflight, result); |
| |
| /* We do not place any restriction on the context in which this function |
| * is called. It may be called from an interrupt handler. Therefore, the |
| * doneq and in-flight values might be accessed from the interrupt level. |
| * Not the best design. But we will use interrupt controls to protect |
| * against that possibility. |
| */ |
| |
| flags = spin_lock_irqsave(NULL); |
| |
| /* Add the completed buffer to the end of our doneq. We do not yet |
| * decrement the reference count. |
| */ |
| |
| dq_addlast((FAR dq_entry_t *)apb, &priv->doneq); |
| |
| /* And decrement the number of buffers in-flight */ |
| |
| DEBUGASSERT(priv->inflight > 0); |
| priv->inflight--; |
| |
| /* Save the result of the transfer */ |
| |
| /* REVISIT: This can be overwritten */ |
| |
| priv->result = result; |
| spin_unlock_irqrestore(NULL, flags); |
| |
| /* Now send a message to the worker thread, informing it that there are |
| * buffers in the done queue that need to be cleaned up. |
| */ |
| |
| msg.msg_id = AUDIO_MSG_COMPLETE; |
| ret = file_mq_send(&priv->mq, (FAR const char *)&msg, sizeof(msg), |
| CONFIG_WM8776_MSG_PRIO); |
| if (ret < 0) |
| { |
| auderr("ERROR: file_mq_send failed: %d\n", ret); |
| } |
| } |
| |
| /**************************************************************************** |
| * Name: wm8776_returnbuffers |
| * |
| * Description: |
| * This function is called after the complete of one or more data |
| * transfers. This function will empty the done queue and release our |
| * reference to each buffer. |
| * |
| ****************************************************************************/ |
| |
| static void wm8776_returnbuffers(FAR struct wm8776_dev_s *priv) |
| { |
| FAR struct ap_buffer_s *apb; |
| irqstate_t flags; |
| |
| /* The doneq and in-flight values might be accessed from the interrupt |
| * level in some implementations. Not the best design. But we will |
| * use interrupt controls to protect against that possibility. |
| */ |
| |
| flags = spin_lock_irqsave(NULL); |
| while (dq_peek(&priv->doneq) != NULL) |
| { |
| /* Take the next buffer from the queue of completed transfers */ |
| |
| apb = (FAR struct ap_buffer_s *)dq_remfirst(&priv->doneq); |
| spin_unlock_irqrestore(NULL, flags); |
| |
| audinfo("Returning: apb=%p curbyte=%d nbytes=%d flags=%04x\n", |
| apb, apb->curbyte, apb->nbytes, apb->flags); |
| |
| /* Are we returning the final buffer in the stream? */ |
| |
| if ((apb->flags & AUDIO_APB_FINAL) != 0) |
| { |
| /* Both the pending and the done queues should be empty and there |
| * should be no buffers in-flight. |
| */ |
| |
| DEBUGASSERT(dq_empty(&priv->doneq) && dq_empty(&priv->pendq) && |
| priv->inflight == 0); |
| |
| /* Set the terminating flag. This will, eventually, cause the |
| * worker thread to exit (if it is not already terminating). |
| */ |
| |
| audinfo("Terminating\n"); |
| priv->terminating = true; |
| } |
| |
| /* Release our reference to the audio buffer */ |
| |
| apb_free(apb); |
| |
| /* Send the buffer back up to the previous level. */ |
| |
| #ifdef CONFIG_AUDIO_MULTI_SESSION |
| priv->dev.upper(priv->dev.priv, AUDIO_CALLBACK_DEQUEUE, apb, OK, NULL); |
| #else |
| priv->dev.upper(priv->dev.priv, AUDIO_CALLBACK_DEQUEUE, apb, OK); |
| #endif |
| flags = spin_lock_irqsave(NULL); |
| } |
| |
| spin_unlock_irqrestore(NULL, flags); |
| } |
| |
| /**************************************************************************** |
| * Name: wm8776_sendbuffer |
| * |
| * Description: |
| * Start the transfer an audio buffer to the WM8776 via I2S. This |
| * will not wait for the transfer to complete but will return immediately. |
| * the wmd8776_senddone called will be invoked when the transfer |
| * completes, stimulating the worker thread to call this function again. |
| * |
| ****************************************************************************/ |
| |
| static int wm8776_sendbuffer(FAR struct wm8776_dev_s *priv) |
| { |
| FAR struct ap_buffer_s *apb; |
| irqstate_t flags; |
| uint32_t timeout; |
| int shift; |
| int ret; |
| |
| /* Loop while there are audio buffers to be sent and we have few than |
| * CONFIG_WM8776_INFLIGHT then "in-flight" |
| * |
| * The 'inflight' value might be modified from the interrupt level in some |
| * implementations. We will use interrupt controls to protect against |
| * that possibility. |
| * |
| * The 'pendq', on the other hand, is protected via a semaphore. Let's |
| * hold the semaphore while we are busy here and disable the interrupts |
| * only while accessing 'inflight'. |
| */ |
| |
| ret = nxmutex_lock(&priv->pendlock); |
| if (ret < 0) |
| { |
| return ret; |
| } |
| |
| while (priv->inflight < CONFIG_WM8776_INFLIGHT && |
| dq_peek(&priv->pendq) != NULL && !priv->paused) |
| { |
| /* Take next buffer from the queue of pending transfers */ |
| |
| apb = (FAR struct ap_buffer_s *)dq_remfirst(&priv->pendq); |
| audinfo("Sending apb=%p, size=%d inflight=%d\n", |
| apb, apb->nbytes, priv->inflight); |
| |
| /* Increment the number of buffers in-flight before sending in order |
| * to avoid a possible race condition. |
| */ |
| |
| flags = spin_lock_irqsave(NULL); |
| priv->inflight++; |
| spin_unlock_irqrestore(NULL, flags); |
| |
| shift = (priv->bpsamp == 8) ? 14 - 3 : 14 - 4; |
| shift -= (priv->nchannels > 1) ? 1 : 0; |
| |
| timeout = MSEC2TICK(((uint32_t)(apb->nbytes - apb->curbyte) << shift) / |
| (uint32_t)priv->samprate); |
| |
| ret = I2S_SEND(priv->i2s, apb, wm8776_senddone, priv, timeout); |
| if (ret < 0) |
| { |
| auderr("ERROR: I2S_SEND failed: %d\n", ret); |
| break; |
| } |
| } |
| |
| nxmutex_unlock(&priv->pendlock); |
| return ret; |
| } |
| |
| /**************************************************************************** |
| * Name: wm8776_start |
| * |
| * Description: |
| * Start the configured operation (audio streaming, volume enabled, etc.). |
| * |
| ****************************************************************************/ |
| |
| #ifdef CONFIG_AUDIO_MULTI_SESSION |
| static int wm8776_start(FAR struct audio_lowerhalf_s *dev, FAR void *session) |
| #else |
| static int wm8776_start(FAR struct audio_lowerhalf_s *dev) |
| #endif |
| { |
| FAR struct wm8776_dev_s *priv = (FAR struct wm8776_dev_s *)dev; |
| struct sched_param sparam; |
| struct mq_attr attr; |
| pthread_attr_t tattr; |
| FAR void *value; |
| int ret; |
| |
| audinfo("Entry\n"); |
| |
| /* Exit reduced power modes of operation */ |
| |
| /* REVISIT */ |
| |
| /* Create a message queue for the worker thread */ |
| |
| snprintf(priv->mqname, sizeof(priv->mqname), "/tmp/%" PRIXPTR, |
| (uintptr_t)priv); |
| |
| attr.mq_maxmsg = 16; |
| attr.mq_msgsize = sizeof(struct audio_msg_s); |
| attr.mq_curmsgs = 0; |
| attr.mq_flags = 0; |
| |
| ret = file_mq_open(&priv->mq, priv->mqname, |
| O_RDWR | O_CREAT, 0644, &attr); |
| if (ret < 0) |
| { |
| /* Error creating message queue! */ |
| |
| auderr("ERROR: Couldn't allocate message queue\n"); |
| return -ENOMEM; |
| } |
| |
| /* Join any old worker thread we had created to prevent a memory leak */ |
| |
| if (priv->threadid != 0) |
| { |
| audinfo("Joining old thread\n"); |
| pthread_join(priv->threadid, &value); |
| } |
| |
| /* Start our thread for sending data to the device */ |
| |
| pthread_attr_init(&tattr); |
| sparam.sched_priority = sched_get_priority_max(SCHED_FIFO) - 3; |
| pthread_attr_setschedparam(&tattr, &sparam); |
| pthread_attr_setstacksize(&tattr, CONFIG_WM8776_WORKER_STACKSIZE); |
| |
| audinfo("Starting worker thread\n"); |
| ret = pthread_create(&priv->threadid, &tattr, wm8776_workerthread, |
| (pthread_addr_t)priv); |
| if (ret != OK) |
| { |
| auderr("ERROR: pthread_create failed: %d\n", ret); |
| } |
| else |
| { |
| pthread_setname_np(priv->threadid, "wm8776"); |
| audinfo("Created worker thread\n"); |
| } |
| |
| return ret; |
| } |
| |
| /**************************************************************************** |
| * Name: wm8776_stop |
| * |
| * Description: Stop the configured operation (audio streaming, volume |
| * disabled, etc.). |
| * |
| ****************************************************************************/ |
| |
| #ifndef CONFIG_AUDIO_EXCLUDE_STOP |
| #ifdef CONFIG_AUDIO_MULTI_SESSION |
| static int wm8776_stop(FAR struct audio_lowerhalf_s *dev, FAR void *session) |
| #else |
| static int wm8776_stop(FAR struct audio_lowerhalf_s *dev) |
| #endif |
| { |
| FAR struct wm8776_dev_s *priv = (FAR struct wm8776_dev_s *)dev; |
| struct audio_msg_s term_msg; |
| FAR void *value; |
| |
| /* Send a message to stop all audio streaming */ |
| |
| term_msg.msg_id = AUDIO_MSG_STOP; |
| term_msg.u.data = 0; |
| file_mq_send(&priv->mq, (FAR const char *)&term_msg, sizeof(term_msg), |
| CONFIG_WM8776_MSG_PRIO); |
| |
| /* Join the worker thread */ |
| |
| pthread_join(priv->threadid, &value); |
| priv->threadid = 0; |
| |
| /* Enter into a reduced power usage mode */ |
| |
| /* REVISIT: */ |
| |
| return OK; |
| } |
| #endif |
| |
| /**************************************************************************** |
| * Name: wm8776_pause |
| * |
| * Description: Pauses the playback. |
| * |
| ****************************************************************************/ |
| |
| #ifndef CONFIG_AUDIO_EXCLUDE_PAUSE_RESUME |
| #ifdef CONFIG_AUDIO_MULTI_SESSION |
| static int wm8776_pause(FAR struct audio_lowerhalf_s *dev, FAR void *session) |
| #else |
| static int wm8776_pause(FAR struct audio_lowerhalf_s *dev) |
| #endif |
| { |
| FAR struct wm8776_dev_s *priv = (FAR struct wm8776_dev_s *)dev; |
| |
| if (priv->running && !priv->paused) |
| { |
| priv->paused = true; |
| wm8776_setvolume(priv, priv->volume, true); |
| } |
| |
| return OK; |
| } |
| #endif /* CONFIG_AUDIO_EXCLUDE_PAUSE_RESUME */ |
| |
| /**************************************************************************** |
| * Name: wm8776_resume |
| * |
| * Description: Resumes the playback. |
| * |
| ****************************************************************************/ |
| |
| #ifndef CONFIG_AUDIO_EXCLUDE_PAUSE_RESUME |
| #ifdef CONFIG_AUDIO_MULTI_SESSION |
| static int wm8776_resume(FAR struct audio_lowerhalf_s *dev, |
| FAR void *session) |
| #else |
| static int wm8776_resume(FAR struct audio_lowerhalf_s *dev) |
| #endif |
| { |
| FAR struct wm8776_dev_s *priv = (FAR struct wm8776_dev_s *)dev; |
| |
| if (priv->running && priv->paused) |
| { |
| priv->paused = false; |
| wm8776_setvolume(priv, priv->volume, false); |
| wm8776_sendbuffer(priv); |
| } |
| |
| return OK; |
| } |
| #endif /* CONFIG_AUDIO_EXCLUDE_PAUSE_RESUME */ |
| |
| /**************************************************************************** |
| * Name: wm8776_enqueuebuffer |
| * |
| * Description: Enqueue an Audio Pipeline Buffer for playback/ processing. |
| * |
| ****************************************************************************/ |
| |
| static int wm8776_enqueuebuffer(FAR struct audio_lowerhalf_s *dev, |
| FAR struct ap_buffer_s *apb) |
| { |
| FAR struct wm8776_dev_s *priv = (FAR struct wm8776_dev_s *)dev; |
| struct audio_msg_s term_msg; |
| int ret; |
| |
| audinfo("Enqueueing: apb=%p curbyte=%d nbytes=%d flags=%04x\n", |
| apb, apb->curbyte, apb->nbytes, apb->flags); |
| |
| /* Take a reference on the new audio buffer */ |
| |
| apb_reference(apb); |
| |
| /* Add the new buffer to the tail of pending audio buffers */ |
| |
| ret = nxmutex_lock(&priv->pendlock); |
| if (ret < 0) |
| { |
| return ret; |
| } |
| |
| apb->flags |= AUDIO_APB_OUTPUT_ENQUEUED; |
| dq_addlast(&apb->dq_entry, &priv->pendq); |
| nxmutex_unlock(&priv->pendlock); |
| |
| /* Send a message to the worker thread indicating that a new buffer has |
| * been enqueued. If mq is NULL, then the playing has not yet started. |
| * In that case we are just "priming the pump" and we don't need to send |
| * any message. |
| */ |
| |
| ret = OK; |
| if (priv->mq.f_inode != NULL) |
| { |
| term_msg.msg_id = AUDIO_MSG_ENQUEUE; |
| term_msg.u.data = 0; |
| |
| ret = file_mq_send(&priv->mq, (FAR const char *)&term_msg, |
| sizeof(term_msg), CONFIG_WM8776_MSG_PRIO); |
| if (ret < 0) |
| { |
| auderr("ERROR: file_mq_send failed: %d\n", ret); |
| } |
| } |
| |
| return ret; |
| } |
| |
| /**************************************************************************** |
| * Name: wm8776_cancelbuffer |
| * |
| * Description: Called when an enqueued buffer is being cancelled. |
| * |
| ****************************************************************************/ |
| |
| static int wm8776_cancelbuffer(FAR struct audio_lowerhalf_s *dev, |
| FAR struct ap_buffer_s *apb) |
| { |
| audinfo("apb=%p\n", apb); |
| return OK; |
| } |
| |
| /**************************************************************************** |
| * Name: wm8776_ioctl |
| * |
| * Description: Perform a device ioctl |
| * |
| ****************************************************************************/ |
| |
| static int wm8776_ioctl(FAR struct audio_lowerhalf_s *dev, int cmd, |
| unsigned long arg) |
| { |
| int ret = OK; |
| #ifdef CONFIG_AUDIO_DRIVER_SPECIFIC_BUFFERS |
| FAR struct ap_buffer_info_s *bufinfo; |
| #endif |
| |
| /* Deal with ioctls passed from the upper-half driver */ |
| |
| switch (cmd) |
| { |
| /* Check for AUDIOIOC_HWRESET ioctl. This ioctl is passed straight |
| * through from the upper-half audio driver. |
| */ |
| |
| case AUDIOIOC_HWRESET: |
| { |
| /* REVISIT: Should we completely re-initialize the chip? We |
| * can't just issue a software reset; that would puts all WM8776 |
| * registers back in their default state. |
| */ |
| |
| audinfo("AUDIOIOC_HWRESET:\n"); |
| } |
| break; |
| |
| /* Report our preferred buffer size and quantity */ |
| |
| #ifdef CONFIG_AUDIO_DRIVER_SPECIFIC_BUFFERS |
| case AUDIOIOC_GETBUFFERINFO: |
| { |
| audinfo("AUDIOIOC_GETBUFFERINFO:\n"); |
| bufinfo = (FAR struct ap_buffer_info_s *) arg; |
| bufinfo->buffer_size = CONFIG_WM8776_BUFFER_SIZE; |
| bufinfo->nbuffers = CONFIG_WM8776_NUM_BUFFERS; |
| } |
| break; |
| #endif |
| |
| default: |
| ret = -ENOTTY; |
| audinfo("Ignored\n"); |
| break; |
| } |
| |
| return ret; |
| } |
| |
| /**************************************************************************** |
| * Name: wm8776_reserve |
| * |
| * Description: Reserves a session (the only one we have). |
| * |
| ****************************************************************************/ |
| |
| #ifdef CONFIG_AUDIO_MULTI_SESSION |
| static int wm8776_reserve(FAR struct audio_lowerhalf_s *dev, |
| FAR void **session) |
| #else |
| static int wm8776_reserve(FAR struct audio_lowerhalf_s *dev) |
| #endif |
| { |
| FAR struct wm8776_dev_s *priv = (FAR struct wm8776_dev_s *) dev; |
| int ret = OK; |
| |
| /* Borrow the APBQ mutex for thread sync */ |
| |
| ret = nxmutex_lock(&priv->pendlock); |
| if (ret < 0) |
| { |
| return ret; |
| } |
| |
| if (priv->reserved) |
| { |
| ret = -EBUSY; |
| } |
| else |
| { |
| /* Initialize the session context */ |
| |
| #ifdef CONFIG_AUDIO_MULTI_SESSION |
| *session = NULL; |
| #endif |
| priv->inflight = 0; |
| priv->running = false; |
| priv->paused = false; |
| #ifndef CONFIG_AUDIO_EXCLUDE_STOP |
| priv->terminating = false; |
| #endif |
| priv->reserved = true; |
| } |
| |
| nxmutex_unlock(&priv->pendlock); |
| return ret; |
| } |
| |
| /**************************************************************************** |
| * Name: wm8776_release |
| * |
| * Description: Releases the session (the only one we have). |
| * |
| ****************************************************************************/ |
| |
| #ifdef CONFIG_AUDIO_MULTI_SESSION |
| static int wm8776_release(FAR struct audio_lowerhalf_s *dev, |
| FAR void *session) |
| #else |
| static int wm8776_release(FAR struct audio_lowerhalf_s *dev) |
| #endif |
| { |
| FAR struct wm8776_dev_s *priv = (FAR struct wm8776_dev_s *)dev; |
| FAR void *value; |
| int ret; |
| |
| /* Join any old worker thread we had created to prevent a memory leak */ |
| |
| if (priv->threadid != 0) |
| { |
| pthread_join(priv->threadid, &value); |
| priv->threadid = 0; |
| } |
| |
| /* Borrow the APBQ mutex for thread sync */ |
| |
| ret = nxmutex_lock(&priv->pendlock); |
| |
| /* Really we should free any queued buffers here */ |
| |
| priv->reserved = false; |
| nxmutex_unlock(&priv->pendlock); |
| |
| return ret; |
| } |
| |
| /**************************************************************************** |
| * Name: wm8776_audio_output |
| * |
| * Description: |
| * Initialize and configure the WM8776 device as an audio output device. |
| * |
| * Input Parameters: |
| * priv - A reference to the driver state structure |
| * |
| * Returned Value: |
| * None. No failures are detected. |
| * |
| ****************************************************************************/ |
| |
| static void wm8776_audio_output(FAR struct wm8776_dev_s *priv) |
| { |
| wm8776_writereg(priv, WM8776_MASTER_ATT, |
| WM8776_UPDATE | 0x58); /* -33db */ |
| wm8776_writereg(priv, WM8776_DAC_IF, 0x32); /* 32bit, I2S, standard pol */ |
| |
| #ifdef CONFIG_WM8776_SWAP_HPOUT |
| wm8776_writereg(priv, WM8776_DAC_CC, 0x62); /* Swap HPOUT L/R */ |
| #endif |
| |
| wm8776_writereg(priv, WM8776_MASTER_MODE, 0x00); /* slave mode, 128fs */ |
| wm8776_writereg(priv, WM8776_PWR_DOWN, 0x12); /* AINPD, ADCPD */ |
| } |
| |
| /**************************************************************************** |
| * Name: wm8776_hw_reset |
| * |
| * Description: |
| * Reset and re-initialize the WM8776 |
| * |
| * Input Parameters: |
| * priv - A reference to the driver state structure |
| * |
| * Returned Value: |
| * None |
| * |
| ****************************************************************************/ |
| |
| static void wm8776_hw_reset(FAR struct wm8776_dev_s *priv) |
| { |
| /* Put audio output back to its initial configuration */ |
| |
| priv->samprate = WM8776_DEFAULT_SAMPRATE; |
| priv->nchannels = WM8776_DEFAULT_NCHANNELS; |
| priv->bpsamp = WM8776_DEFAULT_BPSAMP; |
| #if !defined(CONFIG_AUDIO_EXCLUDE_VOLUME) && !defined(CONFIG_AUDIO_EXCLUDE_BALANCE) |
| priv->balance = b16HALF; /* Center balance */ |
| #endif |
| |
| /* Software reset. This puts all WM8776 registers back in their |
| * default state. |
| */ |
| |
| wm8776_writereg(priv, WM8776_SOFT_RESET, 0x00); |
| |
| /* Configure the WM8776 hardware as an audio input device */ |
| |
| wm8776_audio_output(priv); |
| } |
| |
| /**************************************************************************** |
| * Name: wm8776_workerthread |
| * |
| * This is the thread that feeds data to the chip and keeps the audio |
| * stream going. |
| * |
| ****************************************************************************/ |
| |
| static void *wm8776_workerthread(pthread_addr_t pvarg) |
| { |
| FAR struct wm8776_dev_s *priv = (struct wm8776_dev_s *) pvarg; |
| struct audio_msg_s msg; |
| FAR struct ap_buffer_s *apb; |
| int msglen; |
| unsigned int prio; |
| struct mq_attr attr; |
| |
| audinfo("Entry\n"); |
| |
| #ifndef CONFIG_AUDIO_EXCLUDE_STOP |
| priv->terminating = false; |
| #endif |
| |
| priv->running = true; |
| wm8776_setvolume(priv, priv->volume, false); |
| |
| /* Loop as long as we are supposed to be running and as long as we have |
| * buffers in-flight. |
| */ |
| |
| while (priv->running || priv->inflight > 0) |
| { |
| /* Check if we have been asked to terminate. We have to check if we |
| * still have buffers in-flight. If we do, then we can't stop until |
| * birds come back to roost. |
| */ |
| |
| if (priv->terminating && priv->inflight <= 0) |
| { |
| /* We are IDLE. Break out of the loop and exit. */ |
| |
| break; |
| } |
| else |
| { |
| /* Check if we can send more audio buffers to the WM8776 */ |
| |
| wm8776_sendbuffer(priv); |
| } |
| |
| repeat: |
| |
| /* Wait for messages from our message queue */ |
| |
| msglen = file_mq_receive(&priv->mq, (FAR char *)&msg, |
| sizeof(msg), &prio); |
| |
| /* Handle the case when we return with no message */ |
| |
| if (msglen < sizeof(struct audio_msg_s)) |
| { |
| auderr("ERROR: Message too small: %d\n", msglen); |
| continue; |
| } |
| |
| /* Process the message */ |
| |
| switch (msg.msg_id) |
| { |
| /* The ISR has requested more data. We will catch this case at |
| * the top of the loop. |
| */ |
| |
| case AUDIO_MSG_DATA_REQUEST: |
| audinfo("AUDIO_MSG_DATA_REQUEST\n"); |
| break; |
| |
| /* Stop the playback */ |
| |
| #ifndef CONFIG_AUDIO_EXCLUDE_STOP |
| case AUDIO_MSG_STOP: |
| |
| /* Indicate that we are terminating */ |
| |
| audinfo("AUDIO_MSG_STOP: Terminating\n"); |
| priv->terminating = true; |
| break; |
| #endif |
| |
| /* We have a new buffer to send. We will catch this case at |
| * the top of the loop. |
| */ |
| |
| case AUDIO_MSG_ENQUEUE: |
| audinfo("AUDIO_MSG_ENQUEUE\n"); |
| break; |
| |
| /* We will wake up from the I2S callback with this message */ |
| |
| case AUDIO_MSG_COMPLETE: |
| audinfo("AUDIO_MSG_COMPLETE\n"); |
| wm8776_returnbuffers(priv); |
| break; |
| |
| default: |
| auderr("ERROR: Ignoring message ID %d\n", msg.msg_id); |
| break; |
| } |
| |
| file_mq_getattr(&priv->mq, &attr); |
| |
| /* If there is a message in the queue, process it */ |
| |
| if (0 < attr.mq_curmsgs) |
| { |
| goto repeat; |
| } |
| } |
| |
| /* Reset the WM8776 hardware */ |
| |
| wm8776_hw_reset(priv); |
| |
| /* Return any pending buffers in our pending queue */ |
| |
| nxmutex_lock(&priv->pendlock); |
| while ((apb = (FAR struct ap_buffer_s *)dq_remfirst(&priv->pendq)) != NULL) |
| { |
| /* Release our reference to the buffer */ |
| |
| apb_free(apb); |
| |
| /* Send the buffer back up to the previous level. */ |
| |
| #ifdef CONFIG_AUDIO_MULTI_SESSION |
| priv->dev.upper(priv->dev.priv, AUDIO_CALLBACK_DEQUEUE, apb, OK, NULL); |
| #else |
| priv->dev.upper(priv->dev.priv, AUDIO_CALLBACK_DEQUEUE, apb, OK); |
| #endif |
| } |
| |
| nxmutex_unlock(&priv->pendlock); |
| |
| /* Return any pending buffers in our done queue */ |
| |
| wm8776_returnbuffers(priv); |
| |
| /* Close the message queue */ |
| |
| file_mq_close(&priv->mq); |
| file_mq_unlink(priv->mqname); |
| |
| /* Send an AUDIO_MSG_COMPLETE message to the client */ |
| |
| #ifdef CONFIG_AUDIO_MULTI_SESSION |
| priv->dev.upper(priv->dev.priv, AUDIO_CALLBACK_COMPLETE, NULL, OK, NULL); |
| #else |
| priv->dev.upper(priv->dev.priv, AUDIO_CALLBACK_COMPLETE, NULL, OK); |
| #endif |
| |
| audinfo("Exit\n"); |
| return NULL; |
| } |
| |
| /**************************************************************************** |
| * Public Functions |
| ****************************************************************************/ |
| |
| /**************************************************************************** |
| * Name: wm8776_initialize |
| * |
| * Description: |
| * Initialize the WM8776 device. |
| * |
| * Input Parameters: |
| * i2c - An I2C driver instance |
| * i2s - An I2S driver instance |
| * lower - Persistent board configuration data |
| * |
| * Returned Value: |
| * A new lower half audio interface for the WM8776 device is returned on |
| * success; NULL is returned on failure. |
| * |
| ****************************************************************************/ |
| |
| FAR struct audio_lowerhalf_s * |
| wm8776_initialize(FAR struct i2c_master_s *i2c, |
| FAR struct i2s_dev_s *i2s, |
| FAR const struct wm8776_lower_s *lower) |
| { |
| FAR struct wm8776_dev_s *priv; |
| |
| /* Sanity check */ |
| |
| DEBUGASSERT(i2c && i2s && lower); |
| |
| /* Allocate a WM8776 device structure */ |
| |
| priv = kmm_zalloc(sizeof(struct wm8776_dev_s)); |
| |
| if (priv) |
| { |
| priv->dev.ops = &g_audioops; |
| priv->lower = lower; |
| priv->i2c = i2c; |
| priv->i2s = i2s; |
| |
| nxmutex_init(&priv->pendlock); |
| dq_init(&priv->pendq); |
| dq_init(&priv->doneq); |
| |
| /* Reset and reconfigure the WM8776 hardwaqre */ |
| |
| wm8776_hw_reset(priv); |
| return &priv->dev; |
| } |
| |
| return NULL; |
| } |