4/5
This commit is contained in:
parent
9862f9da7f
commit
1ef1c1ae28
70
us144mkii.c
70
us144mkii.c
|
|
@ -59,6 +59,26 @@ void tascam_free_urbs(struct tascam_card *tascam) {
|
||||||
tascam->feedback_urbs[i] = NULL;
|
tascam->feedback_urbs[i] = NULL;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
usb_kill_anchored_urbs(&tascam->capture_anchor);
|
||||||
|
for (i = 0; i < NUM_CAPTURE_URBS; i++) {
|
||||||
|
if (tascam->capture_urbs[i]) {
|
||||||
|
usb_free_coherent(tascam->dev, tascam->capture_urb_alloc_size,
|
||||||
|
tascam->capture_urbs[i]->transfer_buffer,
|
||||||
|
tascam->capture_urbs[i]->transfer_dma);
|
||||||
|
usb_free_urb(tascam->capture_urbs[i]);
|
||||||
|
tascam->capture_urbs[i] = NULL;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
kfree(tascam->capture_routing_buffer);
|
||||||
|
tascam->capture_routing_buffer = NULL;
|
||||||
|
kfree(tascam->capture_decode_dst_block);
|
||||||
|
tascam->capture_decode_dst_block = NULL;
|
||||||
|
kfree(tascam->capture_decode_raw_block);
|
||||||
|
tascam->capture_decode_raw_block = NULL;
|
||||||
|
kfree(tascam->capture_ring_buffer);
|
||||||
|
tascam->capture_ring_buffer = NULL;
|
||||||
}
|
}
|
||||||
|
|
||||||
int tascam_alloc_urbs(struct tascam_card *tascam) {
|
int tascam_alloc_urbs(struct tascam_card *tascam) {
|
||||||
|
|
@ -112,6 +132,50 @@ int tascam_alloc_urbs(struct tascam_card *tascam) {
|
||||||
f_urb->complete = feedback_urb_complete;
|
f_urb->complete = feedback_urb_complete;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
tascam->capture_urb_alloc_size = CAPTURE_URB_SIZE;
|
||||||
|
for (i = 0; i < NUM_CAPTURE_URBS; i++) {
|
||||||
|
struct urb *c_urb = usb_alloc_urb(0, GFP_KERNEL);
|
||||||
|
|
||||||
|
if (!c_urb)
|
||||||
|
goto error;
|
||||||
|
tascam->capture_urbs[i] = c_urb;
|
||||||
|
|
||||||
|
c_urb->transfer_buffer =
|
||||||
|
usb_alloc_coherent(tascam->dev, tascam->capture_urb_alloc_size,
|
||||||
|
GFP_KERNEL, &c_urb->transfer_dma);
|
||||||
|
if (!c_urb->transfer_buffer)
|
||||||
|
goto error;
|
||||||
|
|
||||||
|
usb_fill_bulk_urb(c_urb, tascam->dev,
|
||||||
|
usb_rcvbulkpipe(tascam->dev, EP_AUDIO_IN),
|
||||||
|
c_urb->transfer_buffer, tascam->capture_urb_alloc_size,
|
||||||
|
capture_urb_complete, tascam);
|
||||||
|
c_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
|
||||||
|
}
|
||||||
|
|
||||||
|
tascam->capture_ring_buffer = kmalloc(CAPTURE_RING_BUFFER_SIZE, GFP_KERNEL);
|
||||||
|
if (!tascam->capture_ring_buffer)
|
||||||
|
goto error;
|
||||||
|
|
||||||
|
tascam->capture_decode_raw_block =
|
||||||
|
kmalloc(RAW_BYTES_PER_DECODE_BLOCK, GFP_KERNEL);
|
||||||
|
if (!tascam->capture_decode_raw_block)
|
||||||
|
goto error;
|
||||||
|
|
||||||
|
tascam->capture_decode_dst_block =
|
||||||
|
kmalloc(FRAMES_PER_DECODE_BLOCK * DECODED_CHANNELS_PER_FRAME *
|
||||||
|
DECODED_SAMPLE_SIZE,
|
||||||
|
GFP_KERNEL);
|
||||||
|
if (!tascam->capture_decode_dst_block)
|
||||||
|
goto error;
|
||||||
|
|
||||||
|
tascam->capture_routing_buffer =
|
||||||
|
kmalloc(FRAMES_PER_DECODE_BLOCK * DECODED_CHANNELS_PER_FRAME *
|
||||||
|
DECODED_SAMPLE_SIZE,
|
||||||
|
GFP_KERNEL);
|
||||||
|
if (!tascam->capture_routing_buffer)
|
||||||
|
goto error;
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
error:
|
error:
|
||||||
|
|
@ -126,6 +190,7 @@ void tascam_stop_work_handler(struct work_struct *work) {
|
||||||
|
|
||||||
usb_kill_anchored_urbs(&tascam->playback_anchor);
|
usb_kill_anchored_urbs(&tascam->playback_anchor);
|
||||||
usb_kill_anchored_urbs(&tascam->feedback_anchor);
|
usb_kill_anchored_urbs(&tascam->feedback_anchor);
|
||||||
|
usb_kill_anchored_urbs(&tascam->capture_anchor);
|
||||||
atomic_set(&tascam->active_urbs, 0);
|
atomic_set(&tascam->active_urbs, 0);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -240,10 +305,12 @@ static int tascam_probe(struct usb_interface *intf,
|
||||||
|
|
||||||
spin_lock_init(&tascam->lock);
|
spin_lock_init(&tascam->lock);
|
||||||
init_usb_anchor(&tascam->playback_anchor);
|
init_usb_anchor(&tascam->playback_anchor);
|
||||||
|
init_usb_anchor(&tascam->capture_anchor);
|
||||||
init_usb_anchor(&tascam->feedback_anchor);
|
init_usb_anchor(&tascam->feedback_anchor);
|
||||||
|
|
||||||
INIT_WORK(&tascam->stop_work, tascam_stop_work_handler);
|
INIT_WORK(&tascam->stop_work, tascam_stop_work_handler);
|
||||||
INIT_WORK(&tascam->stop_pcm_work, tascam_stop_pcm_work_handler);
|
INIT_WORK(&tascam->stop_pcm_work, tascam_stop_pcm_work_handler);
|
||||||
|
INIT_WORK(&tascam->capture_work, tascam_capture_work_handler);
|
||||||
|
|
||||||
err = snd_pcm_new(card, "US144MKII PCM", 0, 1, 1, &tascam->pcm);
|
err = snd_pcm_new(card, "US144MKII PCM", 0, 1, 1, &tascam->pcm);
|
||||||
if (err < 0)
|
if (err < 0)
|
||||||
|
|
@ -303,6 +370,7 @@ static void tascam_disconnect(struct usb_interface *intf) {
|
||||||
if (intf->cur_altsetting->desc.bInterfaceNumber == 0) {
|
if (intf->cur_altsetting->desc.bInterfaceNumber == 0) {
|
||||||
snd_card_disconnect(tascam->card);
|
snd_card_disconnect(tascam->card);
|
||||||
cancel_work_sync(&tascam->stop_work);
|
cancel_work_sync(&tascam->stop_work);
|
||||||
|
cancel_work_sync(&tascam->capture_work);
|
||||||
cancel_work_sync(&tascam->stop_pcm_work);
|
cancel_work_sync(&tascam->stop_pcm_work);
|
||||||
tascam_free_urbs(tascam);
|
tascam_free_urbs(tascam);
|
||||||
snd_card_free(tascam->card);
|
snd_card_free(tascam->card);
|
||||||
|
|
@ -329,8 +397,10 @@ static int tascam_suspend(struct usb_interface *intf, pm_message_t message) {
|
||||||
snd_pcm_suspend_all(tascam->pcm);
|
snd_pcm_suspend_all(tascam->pcm);
|
||||||
|
|
||||||
cancel_work_sync(&tascam->stop_work);
|
cancel_work_sync(&tascam->stop_work);
|
||||||
|
cancel_work_sync(&tascam->capture_work);
|
||||||
cancel_work_sync(&tascam->stop_pcm_work);
|
cancel_work_sync(&tascam->stop_pcm_work);
|
||||||
usb_kill_anchored_urbs(&tascam->playback_anchor);
|
usb_kill_anchored_urbs(&tascam->playback_anchor);
|
||||||
|
usb_kill_anchored_urbs(&tascam->capture_anchor);
|
||||||
usb_kill_anchored_urbs(&tascam->feedback_anchor);
|
usb_kill_anchored_urbs(&tascam->feedback_anchor);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
|
||||||
44
us144mkii.h
44
us144mkii.h
|
|
@ -20,14 +20,17 @@
|
||||||
/* --- USB Endpoints (Alternate Setting 1) --- */
|
/* --- USB Endpoints (Alternate Setting 1) --- */
|
||||||
#define EP_PLAYBACK_FEEDBACK 0x81
|
#define EP_PLAYBACK_FEEDBACK 0x81
|
||||||
#define EP_AUDIO_OUT 0x02
|
#define EP_AUDIO_OUT 0x02
|
||||||
|
#define EP_AUDIO_IN 0x86
|
||||||
|
|
||||||
/* --- USB Control Message Protocol --- */
|
/* --- USB Control Message Protocol --- */
|
||||||
#define RT_H2D_CLASS_EP (USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_ENDPOINT)
|
#define RT_H2D_CLASS_EP (USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_ENDPOINT)
|
||||||
|
#define RT_D2H_CLASS_EP (USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_ENDPOINT)
|
||||||
#define RT_D2H_VENDOR_DEV (USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE)
|
#define RT_D2H_VENDOR_DEV (USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE)
|
||||||
#define RT_H2D_VENDOR_DEV (USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE)
|
#define RT_H2D_VENDOR_DEV (USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE)
|
||||||
|
|
||||||
enum uac_request {
|
enum uac_request {
|
||||||
UAC_SET_CUR = 0x01,
|
UAC_SET_CUR = 0x01,
|
||||||
|
UAC_GET_CUR = 0x81,
|
||||||
};
|
};
|
||||||
|
|
||||||
enum uac_control_selector {
|
enum uac_control_selector {
|
||||||
|
|
@ -64,6 +67,9 @@ enum tascam_register {
|
||||||
#define NUM_FEEDBACK_URBS 4
|
#define NUM_FEEDBACK_URBS 4
|
||||||
#define FEEDBACK_URB_PACKETS 1
|
#define FEEDBACK_URB_PACKETS 1
|
||||||
#define FEEDBACK_PACKET_SIZE 3
|
#define FEEDBACK_PACKET_SIZE 3
|
||||||
|
#define NUM_CAPTURE_URBS 8
|
||||||
|
#define CAPTURE_URB_SIZE 512
|
||||||
|
#define CAPTURE_RING_BUFFER_SIZE (CAPTURE_URB_SIZE * NUM_CAPTURE_URBS * 4)
|
||||||
#define USB_CTRL_TIMEOUT_MS 1000
|
#define USB_CTRL_TIMEOUT_MS 1000
|
||||||
#define FEEDBACK_SYNC_LOSS_THRESHOLD 41
|
#define FEEDBACK_SYNC_LOSS_THRESHOLD 41
|
||||||
|
|
||||||
|
|
@ -73,6 +79,12 @@ enum tascam_register {
|
||||||
#define BYTES_PER_FRAME (NUM_CHANNELS * BYTES_PER_SAMPLE)
|
#define BYTES_PER_FRAME (NUM_CHANNELS * BYTES_PER_SAMPLE)
|
||||||
#define FEEDBACK_ACCUMULATOR_SIZE 128
|
#define FEEDBACK_ACCUMULATOR_SIZE 128
|
||||||
|
|
||||||
|
/* --- Capture Decoding Defines --- */
|
||||||
|
#define DECODED_CHANNELS_PER_FRAME 4
|
||||||
|
#define DECODED_SAMPLE_SIZE 4
|
||||||
|
#define FRAMES_PER_DECODE_BLOCK 8
|
||||||
|
#define RAW_BYTES_PER_DECODE_BLOCK 512
|
||||||
|
|
||||||
struct tascam_card;
|
struct tascam_card;
|
||||||
|
|
||||||
#include "us144mkii_pcm.h"
|
#include "us144mkii_pcm.h"
|
||||||
|
|
@ -117,10 +129,19 @@ struct us144mkii_frame_pattern_observer {
|
||||||
* @last_period_pos: Last reported period position for playback.
|
* @last_period_pos: Last reported period position for playback.
|
||||||
*
|
*
|
||||||
* @capture_substream: Pointer to the active capture PCM substream.
|
* @capture_substream: Pointer to the active capture PCM substream.
|
||||||
|
* @capture_urbs: Array of URBs for capture.
|
||||||
|
* @capture_urb_alloc_size: Size of allocated buffer for each capture URB.
|
||||||
* @capture_active: Atomic flag indicating if capture is active.
|
* @capture_active: Atomic flag indicating if capture is active.
|
||||||
* @driver_capture_pos: Current position in the ALSA capture buffer (frames).
|
* @driver_capture_pos: Current position in the ALSA capture buffer (frames).
|
||||||
* @capture_frames_processed: Total frames processed for capture.
|
* @capture_frames_processed: Total frames processed for capture.
|
||||||
* @last_capture_period_pos: Last reported period position for capture.
|
* @last_capture_period_pos: Last reported period position for capture.
|
||||||
|
* @capture_ring_buffer: Ring buffer for raw capture data from USB.
|
||||||
|
* @capture_ring_buffer_read_ptr: Read pointer for the capture ring buffer.
|
||||||
|
* @capture_ring_buffer_write_ptr: Write pointer for the capture ring buffer.
|
||||||
|
* @capture_decode_raw_block: Buffer for a raw 512-byte capture block.
|
||||||
|
* @capture_decode_dst_block: Buffer for decoded 32-bit capture samples.
|
||||||
|
* @capture_routing_buffer: Intermediate buffer for capture routing.
|
||||||
|
* @capture_work: Work struct for deferred capture processing.
|
||||||
*
|
*
|
||||||
* @stop_work: Work struct for deferred stream stopping.
|
* @stop_work: Work struct for deferred stream stopping.
|
||||||
* @stop_pcm_work: Work struct for stopping PCM due to a fatal error (e.g.
|
* @stop_pcm_work: Work struct for stopping PCM due to a fatal error (e.g.
|
||||||
|
|
@ -141,6 +162,7 @@ struct us144mkii_frame_pattern_observer {
|
||||||
* @fpo: Holds the state for the dynamic feedback pattern generation.
|
* @fpo: Holds the state for the dynamic feedback pattern generation.
|
||||||
*
|
*
|
||||||
* @playback_anchor: USB anchor for playback URBs.
|
* @playback_anchor: USB anchor for playback URBs.
|
||||||
|
* @capture_anchor: USB anchor for capture URBs.
|
||||||
* @feedback_anchor: USB anchor for feedback URBs.
|
* @feedback_anchor: USB anchor for feedback URBs.
|
||||||
*/
|
*/
|
||||||
struct tascam_card {
|
struct tascam_card {
|
||||||
|
|
@ -160,7 +182,10 @@ struct tascam_card {
|
||||||
size_t playback_urb_alloc_size;
|
size_t playback_urb_alloc_size;
|
||||||
struct urb *feedback_urbs[NUM_FEEDBACK_URBS];
|
struct urb *feedback_urbs[NUM_FEEDBACK_URBS];
|
||||||
size_t feedback_urb_alloc_size;
|
size_t feedback_urb_alloc_size;
|
||||||
|
struct urb *capture_urbs[NUM_CAPTURE_URBS];
|
||||||
|
size_t capture_urb_alloc_size;
|
||||||
struct usb_anchor playback_anchor;
|
struct usb_anchor playback_anchor;
|
||||||
|
struct usb_anchor capture_anchor;
|
||||||
struct usb_anchor feedback_anchor;
|
struct usb_anchor feedback_anchor;
|
||||||
|
|
||||||
/* --- Stream State --- */
|
/* --- Stream State --- */
|
||||||
|
|
@ -179,6 +204,12 @@ struct tascam_card {
|
||||||
u64 capture_frames_processed;
|
u64 capture_frames_processed;
|
||||||
snd_pcm_uframes_t driver_capture_pos;
|
snd_pcm_uframes_t driver_capture_pos;
|
||||||
u64 last_capture_period_pos;
|
u64 last_capture_period_pos;
|
||||||
|
u8 *capture_ring_buffer;
|
||||||
|
size_t capture_ring_buffer_read_ptr;
|
||||||
|
size_t capture_ring_buffer_write_ptr;
|
||||||
|
u8 *capture_decode_raw_block;
|
||||||
|
s32 *capture_decode_dst_block;
|
||||||
|
s32 *capture_routing_buffer;
|
||||||
|
|
||||||
/* --- Feedback Sync State --- */
|
/* --- Feedback Sync State --- */
|
||||||
unsigned int feedback_accumulator_pattern[FEEDBACK_ACCUMULATOR_SIZE];
|
unsigned int feedback_accumulator_pattern[FEEDBACK_ACCUMULATOR_SIZE];
|
||||||
|
|
@ -192,14 +223,16 @@ struct tascam_card {
|
||||||
/* --- Workqueues --- */
|
/* --- Workqueues --- */
|
||||||
struct work_struct stop_work;
|
struct work_struct stop_work;
|
||||||
struct work_struct stop_pcm_work;
|
struct work_struct stop_pcm_work;
|
||||||
|
struct work_struct capture_work;
|
||||||
};
|
};
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* tascam_free_urbs() - Free all allocated URBs and associated buffers.
|
* tascam_free_urbs() - Free all allocated URBs and associated buffers.
|
||||||
* @tascam: the tascam_card instance
|
* @tascam: the tascam_card instance
|
||||||
*
|
*
|
||||||
* This function kills, unlinks, and frees all playback and feedback URBs,
|
* This function kills, unlinks, and frees all playback, feedback, and
|
||||||
* along with their transfer buffers.
|
* capture URBs, along with their transfer buffers and the capture
|
||||||
|
* ring/decode buffers.
|
||||||
*/
|
*/
|
||||||
void tascam_free_urbs(struct tascam_card *tascam);
|
void tascam_free_urbs(struct tascam_card *tascam);
|
||||||
|
|
||||||
|
|
@ -207,7 +240,8 @@ void tascam_free_urbs(struct tascam_card *tascam);
|
||||||
* tascam_alloc_urbs() - Allocate all URBs and associated buffers.
|
* tascam_alloc_urbs() - Allocate all URBs and associated buffers.
|
||||||
* @tascam: the tascam_card instance
|
* @tascam: the tascam_card instance
|
||||||
*
|
*
|
||||||
* This function allocates and initializes all URBs for playback and feedback.
|
* This function allocates and initializes all URBs for playback, feedback,
|
||||||
|
* and capture, as well as the necessary buffers for data processing.
|
||||||
*
|
*
|
||||||
* Return: 0 on success, or a negative error code on failure.
|
* Return: 0 on success, or a negative error code on failure.
|
||||||
*/
|
*/
|
||||||
|
|
@ -217,8 +251,8 @@ int tascam_alloc_urbs(struct tascam_card *tascam);
|
||||||
* tascam_stop_work_handler() - Work handler to stop all active streams.
|
* tascam_stop_work_handler() - Work handler to stop all active streams.
|
||||||
* @work: Pointer to the work_struct.
|
* @work: Pointer to the work_struct.
|
||||||
*
|
*
|
||||||
* This function is scheduled to stop all active URBs (playback, feedback)
|
* This function is scheduled to stop all active URBs (playback, feedback,
|
||||||
* and reset the active_urbs counter.
|
* capture) and reset the active_urbs counter.
|
||||||
*/
|
*/
|
||||||
void tascam_stop_work_handler(struct work_struct *work);
|
void tascam_stop_work_handler(struct work_struct *work);
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -43,7 +43,7 @@ static int tascam_capture_close(struct snd_pcm_substream *substream) {
|
||||||
* tascam_capture_prepare() - Prepares the PCM capture substream for use.
|
* tascam_capture_prepare() - Prepares the PCM capture substream for use.
|
||||||
* @substream: The ALSA PCM substream to prepare.
|
* @substream: The ALSA PCM substream to prepare.
|
||||||
*
|
*
|
||||||
* This function initializes capture-related counters.
|
* This function initializes capture-related counters and ring buffer pointers.
|
||||||
*
|
*
|
||||||
* Return: 0 on success.
|
* Return: 0 on success.
|
||||||
*/
|
*/
|
||||||
|
|
@ -53,6 +53,8 @@ static int tascam_capture_prepare(struct snd_pcm_substream *substream) {
|
||||||
tascam->driver_capture_pos = 0;
|
tascam->driver_capture_pos = 0;
|
||||||
tascam->capture_frames_processed = 0;
|
tascam->capture_frames_processed = 0;
|
||||||
tascam->last_capture_period_pos = 0;
|
tascam->last_capture_period_pos = 0;
|
||||||
|
tascam->capture_ring_buffer_read_ptr = 0;
|
||||||
|
tascam->capture_ring_buffer_write_ptr = 0;
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
@ -102,3 +104,183 @@ const struct snd_pcm_ops tascam_capture_ops = {
|
||||||
.trigger = tascam_pcm_trigger,
|
.trigger = tascam_pcm_trigger,
|
||||||
.pointer = tascam_capture_pointer,
|
.pointer = tascam_capture_pointer,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
/**
|
||||||
|
* decode_tascam_capture_block() - Decodes a raw 512-byte block from the device.
|
||||||
|
* @src_block: Pointer to the 512-byte raw source block.
|
||||||
|
* @dst_block: Pointer to the destination buffer for decoded audio frames.
|
||||||
|
*
|
||||||
|
* The device sends audio data in a complex, multiplexed format. This function
|
||||||
|
* demultiplexes the bits from the raw block into 8 frames of 4-channel,
|
||||||
|
* 24-bit audio (stored in 32-bit containers).
|
||||||
|
*/
|
||||||
|
static void decode_tascam_capture_block(const u8 *src_block, s32 *dst_block) {
|
||||||
|
int frame, bit;
|
||||||
|
|
||||||
|
memset(dst_block, 0,
|
||||||
|
FRAMES_PER_DECODE_BLOCK * DECODED_CHANNELS_PER_FRAME *
|
||||||
|
DECODED_SAMPLE_SIZE);
|
||||||
|
|
||||||
|
for (frame = 0; frame < FRAMES_PER_DECODE_BLOCK; ++frame) {
|
||||||
|
const u8 *p_src_frame_base = src_block + frame * 64;
|
||||||
|
s32 *p_dst_frame = dst_block + frame * 4;
|
||||||
|
|
||||||
|
s32 ch[4] = {0};
|
||||||
|
|
||||||
|
for (bit = 0; bit < 24; ++bit) {
|
||||||
|
u8 byte1 = p_src_frame_base[bit];
|
||||||
|
u8 byte2 = p_src_frame_base[bit + 32];
|
||||||
|
|
||||||
|
ch[0] = (ch[0] << 1) | (byte1 & 1);
|
||||||
|
ch[2] = (ch[2] << 1) | ((byte1 >> 1) & 1);
|
||||||
|
|
||||||
|
ch[1] = (ch[1] << 1) | (byte2 & 1);
|
||||||
|
ch[3] = (ch[3] << 1) | ((byte2 >> 1) & 1);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* The result is a 24-bit sample. Shift left by 8 to align it to
|
||||||
|
* the most significant bits of a 32-bit integer (S32_LE format).
|
||||||
|
*/
|
||||||
|
p_dst_frame[0] = ch[0] << 8;
|
||||||
|
p_dst_frame[1] = ch[1] << 8;
|
||||||
|
p_dst_frame[2] = ch[2] << 8;
|
||||||
|
p_dst_frame[3] = ch[3] << 8;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void tascam_capture_work_handler(struct work_struct *work) {
|
||||||
|
struct tascam_card *tascam =
|
||||||
|
container_of(work, struct tascam_card, capture_work);
|
||||||
|
struct snd_pcm_substream *substream = tascam->capture_substream;
|
||||||
|
struct snd_pcm_runtime *runtime;
|
||||||
|
u8 *raw_block = tascam->capture_decode_raw_block;
|
||||||
|
s32 *decoded_block = tascam->capture_decode_dst_block;
|
||||||
|
s32 *routed_block = tascam->capture_routing_buffer;
|
||||||
|
|
||||||
|
if (!substream || !substream->runtime)
|
||||||
|
return;
|
||||||
|
runtime = substream->runtime;
|
||||||
|
|
||||||
|
if (!raw_block || !decoded_block || !routed_block) {
|
||||||
|
dev_err(tascam->card->dev,
|
||||||
|
"Capture decode/routing buffers not allocated!\n");
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
while (atomic_read(&tascam->capture_active)) {
|
||||||
|
size_t write_ptr, read_ptr, available_data;
|
||||||
|
bool can_process;
|
||||||
|
|
||||||
|
{
|
||||||
|
guard(spinlock_irqsave)(&tascam->lock);
|
||||||
|
write_ptr = tascam->capture_ring_buffer_write_ptr;
|
||||||
|
read_ptr = tascam->capture_ring_buffer_read_ptr;
|
||||||
|
available_data = (write_ptr >= read_ptr)
|
||||||
|
? (write_ptr - read_ptr)
|
||||||
|
: (CAPTURE_RING_BUFFER_SIZE - read_ptr + write_ptr);
|
||||||
|
can_process = (available_data >= RAW_BYTES_PER_DECODE_BLOCK);
|
||||||
|
|
||||||
|
if (can_process) {
|
||||||
|
size_t bytes_to_end = CAPTURE_RING_BUFFER_SIZE - read_ptr;
|
||||||
|
if (bytes_to_end >= RAW_BYTES_PER_DECODE_BLOCK) {
|
||||||
|
memcpy(raw_block, tascam->capture_ring_buffer + read_ptr,
|
||||||
|
RAW_BYTES_PER_DECODE_BLOCK);
|
||||||
|
} else {
|
||||||
|
memcpy(raw_block, tascam->capture_ring_buffer + read_ptr,
|
||||||
|
bytes_to_end);
|
||||||
|
memcpy(raw_block + bytes_to_end, tascam->capture_ring_buffer,
|
||||||
|
RAW_BYTES_PER_DECODE_BLOCK - bytes_to_end);
|
||||||
|
}
|
||||||
|
tascam->capture_ring_buffer_read_ptr =
|
||||||
|
(read_ptr + RAW_BYTES_PER_DECODE_BLOCK) % CAPTURE_RING_BUFFER_SIZE;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (!can_process)
|
||||||
|
break;
|
||||||
|
|
||||||
|
decode_tascam_capture_block(raw_block, decoded_block);
|
||||||
|
process_capture_routing_us144mkii(tascam, decoded_block, routed_block);
|
||||||
|
|
||||||
|
{
|
||||||
|
guard(spinlock_irqsave)(&tascam->lock);
|
||||||
|
if (atomic_read(&tascam->capture_active)) {
|
||||||
|
int f;
|
||||||
|
|
||||||
|
for (f = 0; f < FRAMES_PER_DECODE_BLOCK; ++f) {
|
||||||
|
u8 *dst_frame_start =
|
||||||
|
runtime->dma_area +
|
||||||
|
frames_to_bytes(runtime, tascam->driver_capture_pos);
|
||||||
|
s32 *routed_frame_start = routed_block + (f * NUM_CHANNELS);
|
||||||
|
int c;
|
||||||
|
|
||||||
|
for (c = 0; c < NUM_CHANNELS; c++) {
|
||||||
|
u8 *dst_channel = dst_frame_start + (c * BYTES_PER_SAMPLE);
|
||||||
|
s32 *src_channel_s32 = routed_frame_start + c;
|
||||||
|
|
||||||
|
memcpy(dst_channel, ((char *)src_channel_s32) + 1, 3);
|
||||||
|
}
|
||||||
|
|
||||||
|
tascam->driver_capture_pos =
|
||||||
|
(tascam->driver_capture_pos + 1) % runtime->buffer_size;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void capture_urb_complete(struct urb *urb) {
|
||||||
|
struct tascam_card *tascam = urb->context;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
if (urb->status) {
|
||||||
|
if (urb->status != -ENOENT && urb->status != -ECONNRESET &&
|
||||||
|
urb->status != -ESHUTDOWN && urb->status != -ENODEV &&
|
||||||
|
urb->status != -EPROTO)
|
||||||
|
dev_err_ratelimited(tascam->card->dev, "Capture URB failed: %d\n",
|
||||||
|
urb->status);
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
if (!tascam || !atomic_read(&tascam->capture_active))
|
||||||
|
goto out;
|
||||||
|
|
||||||
|
if (urb->actual_length > 0) {
|
||||||
|
size_t write_ptr;
|
||||||
|
size_t bytes_to_end;
|
||||||
|
|
||||||
|
{
|
||||||
|
guard(spinlock_irqsave)(&tascam->lock);
|
||||||
|
write_ptr = tascam->capture_ring_buffer_write_ptr;
|
||||||
|
bytes_to_end = CAPTURE_RING_BUFFER_SIZE - write_ptr;
|
||||||
|
|
||||||
|
if (urb->actual_length > bytes_to_end) {
|
||||||
|
memcpy(tascam->capture_ring_buffer + write_ptr, urb->transfer_buffer,
|
||||||
|
bytes_to_end);
|
||||||
|
memcpy(tascam->capture_ring_buffer, urb->transfer_buffer + bytes_to_end,
|
||||||
|
urb->actual_length - bytes_to_end);
|
||||||
|
} else {
|
||||||
|
memcpy(tascam->capture_ring_buffer + write_ptr, urb->transfer_buffer,
|
||||||
|
urb->actual_length);
|
||||||
|
}
|
||||||
|
|
||||||
|
tascam->capture_ring_buffer_write_ptr =
|
||||||
|
(write_ptr + urb->actual_length) % CAPTURE_RING_BUFFER_SIZE;
|
||||||
|
}
|
||||||
|
|
||||||
|
schedule_work(&tascam->capture_work);
|
||||||
|
}
|
||||||
|
|
||||||
|
usb_get_urb(urb);
|
||||||
|
usb_anchor_urb(urb, &tascam->capture_anchor);
|
||||||
|
ret = usb_submit_urb(urb, GFP_ATOMIC);
|
||||||
|
if (ret < 0) {
|
||||||
|
dev_err_ratelimited(tascam->card->dev,
|
||||||
|
"Failed to resubmit capture URB: %d\n", ret);
|
||||||
|
usb_unanchor_urb(urb);
|
||||||
|
usb_put_urb(urb);
|
||||||
|
atomic_dec(&tascam->active_urbs); /* Decrement on failed resubmission */
|
||||||
|
}
|
||||||
|
out:
|
||||||
|
usb_put_urb(urb);
|
||||||
|
}
|
||||||
|
|
|
||||||
|
|
@ -59,6 +59,15 @@ void process_playback_routing_us144mkii(struct tascam_card *tascam,
|
||||||
memcpy(dst_buffer, src_buffer, frames * BYTES_PER_FRAME);
|
memcpy(dst_buffer, src_buffer, frames * BYTES_PER_FRAME);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
void process_capture_routing_us144mkii(struct tascam_card *tascam,
|
||||||
|
const s32 *decoded_block,
|
||||||
|
s32 *routed_block) {
|
||||||
|
/* This is a stub. Routing will be added in a later commit. */
|
||||||
|
memcpy(routed_block, decoded_block,
|
||||||
|
FRAMES_PER_DECODE_BLOCK * DECODED_CHANNELS_PER_FRAME *
|
||||||
|
DECODED_SAMPLE_SIZE);
|
||||||
|
}
|
||||||
|
|
||||||
int us144mkii_configure_device_for_rate(struct tascam_card *tascam, int rate) {
|
int us144mkii_configure_device_for_rate(struct tascam_card *tascam, int rate) {
|
||||||
struct usb_device *dev = tascam->dev;
|
struct usb_device *dev = tascam->dev;
|
||||||
u8 *rate_payload_buf;
|
u8 *rate_payload_buf;
|
||||||
|
|
@ -104,6 +113,11 @@ int us144mkii_configure_device_for_rate(struct tascam_card *tascam, int rate) {
|
||||||
USB_CTRL_TIMEOUT_MS);
|
USB_CTRL_TIMEOUT_MS);
|
||||||
if (err < 0)
|
if (err < 0)
|
||||||
goto fail;
|
goto fail;
|
||||||
|
err = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), UAC_SET_CUR,
|
||||||
|
RT_H2D_CLASS_EP, UAC_SAMPLING_FREQ_CONTROL, EP_AUDIO_IN,
|
||||||
|
rate_payload_buf, 3, USB_CTRL_TIMEOUT_MS);
|
||||||
|
if (err < 0)
|
||||||
|
goto fail;
|
||||||
err = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), UAC_SET_CUR,
|
err = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), UAC_SET_CUR,
|
||||||
RT_H2D_CLASS_EP, UAC_SAMPLING_FREQ_CONTROL,
|
RT_H2D_CLASS_EP, UAC_SAMPLING_FREQ_CONTROL,
|
||||||
EP_AUDIO_OUT, rate_payload_buf, 3, USB_CTRL_TIMEOUT_MS);
|
EP_AUDIO_OUT, rate_payload_buf, 3, USB_CTRL_TIMEOUT_MS);
|
||||||
|
|
@ -250,6 +264,18 @@ int tascam_pcm_trigger(struct snd_pcm_substream *substream, int cmd) {
|
||||||
}
|
}
|
||||||
atomic_inc(&tascam->active_urbs);
|
atomic_inc(&tascam->active_urbs);
|
||||||
}
|
}
|
||||||
|
for (i = 0; i < NUM_CAPTURE_URBS; i++) {
|
||||||
|
usb_get_urb(tascam->capture_urbs[i]);
|
||||||
|
usb_anchor_urb(tascam->capture_urbs[i], &tascam->capture_anchor);
|
||||||
|
err = usb_submit_urb(tascam->capture_urbs[i], GFP_ATOMIC);
|
||||||
|
if (err < 0) {
|
||||||
|
usb_unanchor_urb(tascam->capture_urbs[i]);
|
||||||
|
usb_put_urb(tascam->capture_urbs[i]);
|
||||||
|
atomic_dec(&tascam->active_urbs);
|
||||||
|
goto start_rollback;
|
||||||
|
}
|
||||||
|
atomic_inc(&tascam->active_urbs);
|
||||||
|
}
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
start_rollback:
|
start_rollback:
|
||||||
|
|
|
||||||
|
|
@ -51,6 +51,16 @@ void playback_urb_complete(struct urb *urb);
|
||||||
*/
|
*/
|
||||||
void feedback_urb_complete(struct urb *urb);
|
void feedback_urb_complete(struct urb *urb);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* capture_urb_complete() - Completion handler for capture bulk URBs.
|
||||||
|
* @urb: the completed URB
|
||||||
|
*
|
||||||
|
* This function runs in interrupt context. It copies the received raw data
|
||||||
|
* into an intermediate ring buffer and then schedules the workqueue to process
|
||||||
|
* it. It then resubmits the URB to receive more data.
|
||||||
|
*/
|
||||||
|
void capture_urb_complete(struct urb *urb);
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* tascam_stop_pcm_work_handler() - Work handler to stop PCM streams.
|
* tascam_stop_pcm_work_handler() - Work handler to stop PCM streams.
|
||||||
* @work: Pointer to the work_struct.
|
* @work: Pointer to the work_struct.
|
||||||
|
|
@ -64,8 +74,8 @@ void tascam_stop_pcm_work_handler(struct work_struct *work);
|
||||||
* tascam_init_pcm() - Initializes the ALSA PCM device.
|
* tascam_init_pcm() - Initializes the ALSA PCM device.
|
||||||
* @pcm: Pointer to the ALSA PCM device to initialize.
|
* @pcm: Pointer to the ALSA PCM device to initialize.
|
||||||
*
|
*
|
||||||
* This function sets up the PCM operations and preallocates pages for the
|
* This function sets up the PCM operations, adds ALSA controls for routing
|
||||||
* PCM buffer.
|
* and sample rate, and preallocates pages for the PCM buffer.
|
||||||
*
|
*
|
||||||
* Return: 0 on success, or a negative error code on failure.
|
* Return: 0 on success, or a negative error code on failure.
|
||||||
*/
|
*/
|
||||||
|
|
@ -94,6 +104,16 @@ void process_playback_routing_us144mkii(struct tascam_card *tascam,
|
||||||
const u8 *src_buffer, u8 *dst_buffer,
|
const u8 *src_buffer, u8 *dst_buffer,
|
||||||
size_t frames);
|
size_t frames);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* process_capture_routing_us144mkii() - Apply capture routing matrix
|
||||||
|
* @tascam: The driver instance.
|
||||||
|
* @decoded_block: Buffer containing 4 channels of S32LE decoded audio.
|
||||||
|
* @routed_block: Buffer to be filled for ALSA.
|
||||||
|
*/
|
||||||
|
void process_capture_routing_us144mkii(struct tascam_card *tascam,
|
||||||
|
const s32 *decoded_block,
|
||||||
|
s32 *routed_block);
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* tascam_pcm_hw_params() - Configures hardware parameters for PCM streams.
|
* tascam_pcm_hw_params() - Configures hardware parameters for PCM streams.
|
||||||
* @substream: The ALSA PCM substream.
|
* @substream: The ALSA PCM substream.
|
||||||
|
|
@ -131,4 +151,15 @@ int tascam_pcm_hw_free(struct snd_pcm_substream *substream);
|
||||||
*/
|
*/
|
||||||
int tascam_pcm_trigger(struct snd_pcm_substream *substream, int cmd);
|
int tascam_pcm_trigger(struct snd_pcm_substream *substream, int cmd);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* tascam_capture_work_handler() - Deferred work for processing capture data.
|
||||||
|
* @work: the work_struct instance
|
||||||
|
*
|
||||||
|
* This function runs in a kernel thread context, not an IRQ context. It reads
|
||||||
|
* raw data from the capture ring buffer, decodes it, applies routing, and
|
||||||
|
* copies the final audio data into the ALSA capture ring buffer. This offloads
|
||||||
|
* the CPU-intensive decoding from the time-sensitive URB completion handlers.
|
||||||
|
*/
|
||||||
|
void tascam_capture_work_handler(struct work_struct *work);
|
||||||
|
|
||||||
#endif /* __US144MKII_PCM_H */
|
#endif /* __US144MKII_PCM_H */
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue