efficiency & stability improvements

This commit is contained in:
Šerif Rami 2026-01-11 20:51:30 +01:00
parent 6951cf48af
commit dd9e2f8b81
2 changed files with 102 additions and 135 deletions

View File

@ -63,13 +63,13 @@ enum tascam_register {
#define REG_VAL_ENABLE 0x0101
#define NUM_PLAYBACK_URBS 2
#define NUM_PLAYBACK_URBS 4
#define PLAYBACK_URB_PACKETS 8
#define NUM_FEEDBACK_URBS 4
#define FEEDBACK_URB_PACKETS 1
#define FEEDBACK_PACKET_SIZE 3
#define NUM_CAPTURE_URBS 32
#define CAPTURE_PACKET_SIZE 512
#define NUM_CAPTURE_URBS 8
#define CAPTURE_PACKET_SIZE 4096
#define MIDI_PACKET_SIZE 9
#define MIDI_PAYLOAD_SIZE 8
@ -78,6 +78,7 @@ enum tascam_register {
#define NUM_CHANNELS 4
#define PLAYBACK_FRAME_SIZE (NUM_CHANNELS * BYTES_PER_SAMPLE)
#define MAX_FRAMES_PER_PACKET 13
#define PLL_FILTER_OLD_WEIGHT 3
#define PLL_FILTER_NEW_WEIGHT 1

View File

@ -37,9 +37,10 @@ static int tascam_playback_close(struct snd_pcm_substream *substream)
struct tascam_card *tascam = snd_pcm_substream_chip(substream);
atomic_set(&tascam->playback_active, 0);
cancel_work_sync(&tascam->stop_pcm_work);
usb_kill_anchored_urbs(&tascam->playback_anchor);
usb_kill_anchored_urbs(&tascam->feedback_anchor);
tascam->playback_substream = NULL;
return 0;
}
@ -58,7 +59,9 @@ static int tascam_playback_prepare(struct snd_pcm_substream *substream)
tascam->playback_frames_consumed = 0;
tascam->last_pb_period_pos = 0;
tascam->feedback_synced = false;
tascam->feedback_urb_skip_count = NUM_FEEDBACK_URBS;
tascam->feedback_urb_skip_count = 4;
tascam->phase_accum = 0;
tascam->freq_q16 = div_u64(((u64)runtime->rate << 16), 8000);
@ -75,14 +78,18 @@ static int tascam_playback_prepare(struct snd_pcm_substream *substream)
for (u = 0; u < NUM_PLAYBACK_URBS; u++) {
struct urb *urb = tascam->playback_urbs[u];
int num_packets = PLAYBACK_URB_PACKETS;
size_t total_bytes = 0;
urb->number_of_packets = num_packets;
urb->transfer_buffer_length = num_packets * nominal_bytes;
for (i = 0; i < num_packets; i++) {
urb->number_of_packets = PLAYBACK_URB_PACKETS;
for (i = 0; i < PLAYBACK_URB_PACKETS; i++) {
urb->iso_frame_desc[i].offset = i * nominal_bytes;
urb->iso_frame_desc[i].length = nominal_bytes;
total_bytes += nominal_bytes;
}
urb->transfer_buffer_length = total_bytes;
memset(urb->transfer_buffer, 0, total_bytes);
}
return 0;
}
@ -92,94 +99,80 @@ static snd_pcm_uframes_t tascam_playback_pointer(struct snd_pcm_substream *subst
struct tascam_card *tascam = snd_pcm_substream_chip(substream);
unsigned long flags;
u64 pos;
snd_pcm_uframes_t buffer_size = substream->runtime->buffer_size;
if (!atomic_read(&tascam->playback_active))
return 0;
spin_lock_irqsave(&tascam->lock, flags);
pos = tascam->playback_frames_consumed;
spin_unlock_irqrestore(&tascam->lock, flags);
return (snd_pcm_uframes_t)(pos % buffer_size);
return (snd_pcm_uframes_t)(pos % substream->runtime->buffer_size);
}
static int tascam_playback_trigger(struct snd_pcm_substream *substream, int cmd)
{
struct tascam_card *tascam = snd_pcm_substream_chip(substream);
int i, ret = 0;
bool start = false;
bool stop = false;
unsigned long flags;
spin_lock_irqsave(&tascam->lock, flags);
switch (cmd) {
case SNDRV_PCM_TRIGGER_START:
case SNDRV_PCM_TRIGGER_RESUME:
if (!atomic_read(&tascam->playback_active)) {
atomic_set(&tascam->playback_active, 1);
tascam->feedback_synced = false;
tascam->feedback_urb_skip_count = NUM_FEEDBACK_URBS;
start = true;
spin_lock_irqsave(&tascam->lock, flags);
if (atomic_read(&tascam->playback_active)) {
spin_unlock_irqrestore(&tascam->lock, flags);
return 0;
}
atomic_set(&tascam->playback_active, 1);
tascam->feedback_synced = false;
spin_unlock_irqrestore(&tascam->lock, flags);
for (i = 0; i < NUM_FEEDBACK_URBS; i++) {
usb_anchor_urb(tascam->feedback_urbs[i], &tascam->feedback_anchor);
if (usb_submit_urb(tascam->feedback_urbs[i], GFP_ATOMIC) < 0) {
usb_unanchor_urb(tascam->feedback_urbs[i]);
ret = -EIO;
goto error;
}
atomic_inc(&tascam->active_urbs);
}
for (i = 0; i < NUM_PLAYBACK_URBS; i++) {
usb_anchor_urb(tascam->playback_urbs[i], &tascam->playback_anchor);
if (usb_submit_urb(tascam->playback_urbs[i], GFP_ATOMIC) < 0) {
usb_unanchor_urb(tascam->playback_urbs[i]);
ret = -EIO;
goto error;
}
atomic_inc(&tascam->active_urbs);
}
break;
case SNDRV_PCM_TRIGGER_STOP:
case SNDRV_PCM_TRIGGER_SUSPEND:
case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
atomic_set(&tascam->playback_active, 0);
stop = true;
for (i = 0; i < NUM_PLAYBACK_URBS; i++) {
if (tascam->playback_urbs[i])
usb_unlink_urb(tascam->playback_urbs[i]);
}
for (i = 0; i < NUM_FEEDBACK_URBS; i++) {
if (tascam->feedback_urbs[i])
usb_unlink_urb(tascam->feedback_urbs[i]);
}
break;
default:
ret = -EINVAL;
break;
}
spin_unlock_irqrestore(&tascam->lock, flags);
if (stop) {
smp_mb();
for (i = 0; i < NUM_FEEDBACK_URBS; i++) {
if (tascam->feedback_urbs[i])
usb_unlink_urb(tascam->feedback_urbs[i]);
}
for (i = 0; i < NUM_PLAYBACK_URBS; i++) {
if (tascam->playback_urbs[i])
usb_unlink_urb(tascam->playback_urbs[i]);
}
return -EINVAL;
}
if (start) {
for (i = 0; i < NUM_FEEDBACK_URBS; i++) {
usb_anchor_urb(tascam->feedback_urbs[i], &tascam->feedback_anchor);
if (usb_submit_urb(tascam->feedback_urbs[i], GFP_ATOMIC) < 0) {
usb_unanchor_urb(tascam->feedback_urbs[i]);
atomic_set(&tascam->playback_active, 0);
smp_mb();
for (int j = 0; j < i; j++)
usb_unlink_urb(tascam->feedback_urbs[j]);
ret = -EIO;
goto error;
}
atomic_inc(&tascam->active_urbs);
}
for (i = 0; i < NUM_PLAYBACK_URBS; i++) {
usb_anchor_urb(tascam->playback_urbs[i], &tascam->playback_anchor);
if (usb_submit_urb(tascam->playback_urbs[i], GFP_ATOMIC) < 0) {
usb_unanchor_urb(tascam->playback_urbs[i]);
atomic_set(&tascam->playback_active, 0);
smp_mb();
for (int j = 0; j < NUM_FEEDBACK_URBS; j++)
usb_unlink_urb(tascam->feedback_urbs[j]);
for (int j = 0; j < i; j++)
usb_unlink_urb(tascam->playback_urbs[j]);
ret = -EIO;
goto error;
}
atomic_inc(&tascam->active_urbs);
}
} else if (stop && ret == 0) {
schedule_work(&tascam->stop_work);
}
return 0;
error:
atomic_set(&tascam->playback_active, 0);
usb_kill_anchored_urbs(&tascam->playback_anchor);
usb_kill_anchored_urbs(&tascam->feedback_anchor);
return ret;
}
@ -197,44 +190,24 @@ void playback_urb_complete(struct urb *urb)
struct snd_pcm_substream *substream;
struct snd_pcm_runtime *runtime;
size_t total_bytes_for_urb = 0;
snd_pcm_uframes_t offset_frames;
snd_pcm_uframes_t frames_to_copy;
int i;
unsigned long flags;
bool need_period_elapsed = false;
snd_pcm_uframes_t buffer_size, period_size;
if (!tascam)
return;
if (urb->status == -ENOENT || urb->status == -ECONNRESET ||
urb->status == -ESHUTDOWN || !tascam) {
goto exit_clear;
}
if (urb->status) {
usb_unanchor_urb(urb);
atomic_dec(&tascam->active_urbs);
return;
}
if (!atomic_read(&tascam->playback_active))
goto exit_clear;
substream = tascam->playback_substream;
if (!substream || !substream->runtime) {
atomic_dec(&tascam->active_urbs);
return;
}
runtime = substream->runtime;
if (!runtime->dma_area) {
atomic_dec(&tascam->active_urbs);
return;
}
buffer_size = runtime->buffer_size;
period_size = runtime->period_size;
spin_lock_irqsave(&tascam->lock, flags);
if (!atomic_read(&tascam->playback_active)) {
spin_unlock_irqrestore(&tascam->lock, flags);
atomic_dec(&tascam->active_urbs);
return;
}
for (i = 0; i < urb->number_of_packets; i++) {
unsigned int frames_for_packet;
@ -242,8 +215,8 @@ void playback_urb_complete(struct urb *urb)
frames_for_packet = tascam->phase_accum >> 16;
tascam->phase_accum &= 0xFFFF;
if (frames_for_packet > 13)
frames_for_packet = 13;
if (frames_for_packet > MAX_FRAMES_PER_PACKET)
frames_for_packet = MAX_FRAMES_PER_PACKET;
urb->iso_frame_desc[i].offset = total_bytes_for_urb;
urb->iso_frame_desc[i].length = frames_for_packet * PLAYBACK_FRAME_SIZE;
@ -251,17 +224,13 @@ void playback_urb_complete(struct urb *urb)
}
urb->transfer_buffer_length = total_bytes_for_urb;
offset_frames = tascam->driver_playback_pos;
frames_to_copy = bytes_to_frames(runtime, total_bytes_for_urb);
tascam->driver_playback_pos = (offset_frames + frames_to_copy) % buffer_size;
if (total_bytes_for_urb > 0) {
u8 *dst_buf = urb->transfer_buffer;
size_t ptr_bytes = frames_to_bytes(runtime, offset_frames);
size_t ptr_bytes = frames_to_bytes(runtime, tascam->driver_playback_pos);
frames_to_copy = bytes_to_frames(runtime, total_bytes_for_urb);
if (offset_frames + frames_to_copy > buffer_size) {
size_t part1 = buffer_size - offset_frames;
if (tascam->driver_playback_pos + frames_to_copy > runtime->buffer_size) {
size_t part1 = runtime->buffer_size - tascam->driver_playback_pos;
size_t part1_bytes = frames_to_bytes(runtime, part1);
memcpy(dst_buf, runtime->dma_area + ptr_bytes, part1_bytes);
@ -269,15 +238,15 @@ void playback_urb_complete(struct urb *urb)
} else {
memcpy(dst_buf, runtime->dma_area + ptr_bytes, total_bytes_for_urb);
}
}
tascam->playback_frames_consumed += frames_to_copy;
tascam->driver_playback_pos += frames_to_copy;
if (tascam->driver_playback_pos >= runtime->buffer_size)
tascam->driver_playback_pos -= runtime->buffer_size;
if (period_size > 0) {
u64 current_period = div_u64(tascam->playback_frames_consumed, period_size);
tascam->playback_frames_consumed += frames_to_copy;
if (current_period > tascam->last_pb_period_pos) {
tascam->last_pb_period_pos = current_period;
if (div_u64(tascam->playback_frames_consumed, runtime->period_size) > tascam->last_pb_period_pos) {
tascam->last_pb_period_pos = div_u64(tascam->playback_frames_consumed, runtime->period_size);
need_period_elapsed = true;
}
}
@ -287,11 +256,14 @@ void playback_urb_complete(struct urb *urb)
snd_pcm_period_elapsed(substream);
usb_anchor_urb(urb, &tascam->playback_anchor);
if (usb_submit_urb(urb, GFP_ATOMIC) < 0) {
usb_unanchor_urb(urb);
atomic_dec(&tascam->active_urbs);
return;
}
if (usb_submit_urb(urb, GFP_ATOMIC) < 0)
goto exit_clear;
return;
exit_clear:
usb_unanchor_urb(urb);
atomic_dec(&tascam->active_urbs);
}
/**
@ -308,27 +280,16 @@ void playback_urb_complete(struct urb *urb)
void feedback_urb_complete(struct urb *urb)
{
struct tascam_card *tascam = urb->context;
int ret, p;
unsigned long flags;
bool playback_active;
int p;
if (!tascam)
return;
if (urb->status) {
if (urb->status || !tascam || !atomic_read(&tascam->playback_active)) {
usb_unanchor_urb(urb);
atomic_dec(&tascam->active_urbs);
return;
}
spin_lock_irqsave(&tascam->lock, flags);
playback_active = atomic_read(&tascam->playback_active);
if (!playback_active) {
spin_unlock_irqrestore(&tascam->lock, flags);
usb_unanchor_urb(urb);
atomic_dec(&tascam->active_urbs);
return;
}
if (tascam->feedback_urb_skip_count > 0) {
tascam->feedback_urb_skip_count--;
@ -337,15 +298,21 @@ void feedback_urb_complete(struct urb *urb)
}
for (p = 0; p < urb->number_of_packets; p++) {
if (urb->iso_frame_desc[p].status == 0 && urb->iso_frame_desc[p].actual_length >= 3) {
if (urb->iso_frame_desc[p].status == 0 && urb->iso_frame_desc[p].actual_length >= 1) {
u8 *data = (u8 *)urb->transfer_buffer + urb->iso_frame_desc[p].offset;
u32 sum_frames_3ms = data[0] + data[1] + data[2];
u32 target_freq_q16 = (sum_frames_3ms * 65536) / 24;
u32 sum_frames_3ms;
u32 target_freq_q16;
if (urb->iso_frame_desc[p].actual_length >= 3) {
sum_frames_3ms = data[0] + data[1] + data[2];
} else {
sum_frames_3ms = data[0] * 3;
}
target_freq_q16 = (sum_frames_3ms << 16) / 24;
tascam->freq_q16 = (tascam->freq_q16 * PLL_FILTER_OLD_WEIGHT +
target_freq_q16 * PLL_FILTER_NEW_WEIGHT +
(PLL_FILTER_DIVISOR >> 1)) / PLL_FILTER_DIVISOR;
target_freq_q16 * PLL_FILTER_NEW_WEIGHT) / PLL_FILTER_DIVISOR;
tascam->feedback_synced = true;
}
@ -354,8 +321,7 @@ void feedback_urb_complete(struct urb *urb)
resubmit:
usb_anchor_urb(urb, &tascam->feedback_anchor);
ret = usb_submit_urb(urb, GFP_ATOMIC);
if (ret < 0) {
if (usb_submit_urb(urb, GFP_ATOMIC) < 0) {
usb_unanchor_urb(urb);
atomic_dec(&tascam->active_urbs);
}