Commit 860d798c authored by Takashi Sakamoto's avatar Takashi Sakamoto Committed by Takashi Iwai

ALSA: firewire-lib: operate data block counter in top level of processing for IT context

In ALSA IEC 61883-1/6 packet streaming engine, two types of data block
counter are supported. This commit applies code refactoring to make it
explicitly for IT context.
Signed-off-by: default avatarTakashi Sakamoto <o-takashi@sakamocchi.jp>
Signed-off-by: default avatarTakashi Iwai <tiwai@suse.de>
parent ab754812
...@@ -473,12 +473,12 @@ static inline int queue_in_packet(struct amdtp_stream *s, ...@@ -473,12 +473,12 @@ static inline int queue_in_packet(struct amdtp_stream *s,
} }
static void generate_cip_header(struct amdtp_stream *s, __be32 cip_header[2], static void generate_cip_header(struct amdtp_stream *s, __be32 cip_header[2],
unsigned int syt) unsigned int data_block_counter, unsigned int syt)
{ {
cip_header[0] = cpu_to_be32(READ_ONCE(s->source_node_id_field) | cip_header[0] = cpu_to_be32(READ_ONCE(s->source_node_id_field) |
(s->data_block_quadlets << CIP_DBS_SHIFT) | (s->data_block_quadlets << CIP_DBS_SHIFT) |
((s->sph << CIP_SPH_SHIFT) & CIP_SPH_MASK) | ((s->sph << CIP_SPH_SHIFT) & CIP_SPH_MASK) |
s->data_block_counter); data_block_counter);
cip_header[1] = cpu_to_be32(CIP_EOH | cip_header[1] = cpu_to_be32(CIP_EOH |
((s->fmt << CIP_FMT_SHIFT) & CIP_FMT_MASK) | ((s->fmt << CIP_FMT_SHIFT) & CIP_FMT_MASK) |
((s->ctx_data.rx.fdf << CIP_FDF_SHIFT) & CIP_FDF_MASK) | ((s->ctx_data.rx.fdf << CIP_FDF_SHIFT) & CIP_FDF_MASK) |
...@@ -487,8 +487,9 @@ static void generate_cip_header(struct amdtp_stream *s, __be32 cip_header[2], ...@@ -487,8 +487,9 @@ static void generate_cip_header(struct amdtp_stream *s, __be32 cip_header[2],
static void build_it_pkt_header(struct amdtp_stream *s, unsigned int cycle, static void build_it_pkt_header(struct amdtp_stream *s, unsigned int cycle,
struct fw_iso_packet *params, struct fw_iso_packet *params,
unsigned int data_blocks, unsigned int syt, unsigned int data_blocks,
unsigned int index) unsigned int data_block_counter,
unsigned int syt, unsigned int index)
{ {
unsigned int payload_length; unsigned int payload_length;
__be32 *cip_header; __be32 *cip_header;
...@@ -496,14 +497,9 @@ static void build_it_pkt_header(struct amdtp_stream *s, unsigned int cycle, ...@@ -496,14 +497,9 @@ static void build_it_pkt_header(struct amdtp_stream *s, unsigned int cycle,
payload_length = data_blocks * sizeof(__be32) * s->data_block_quadlets; payload_length = data_blocks * sizeof(__be32) * s->data_block_quadlets;
params->payload_length = payload_length; params->payload_length = payload_length;
if (s->flags & CIP_DBC_IS_END_EVENT) {
s->data_block_counter =
(s->data_block_counter + data_blocks) & 0xff;
}
if (!(s->flags & CIP_NO_HEADER)) { if (!(s->flags & CIP_NO_HEADER)) {
cip_header = (__be32 *)params->header; cip_header = (__be32 *)params->header;
generate_cip_header(s, cip_header, syt); generate_cip_header(s, cip_header, data_block_counter, syt);
params->header_length = 2 * sizeof(__be32); params->header_length = 2 * sizeof(__be32);
payload_length += params->header_length; payload_length += params->header_length;
} else { } else {
...@@ -511,12 +507,7 @@ static void build_it_pkt_header(struct amdtp_stream *s, unsigned int cycle, ...@@ -511,12 +507,7 @@ static void build_it_pkt_header(struct amdtp_stream *s, unsigned int cycle,
} }
trace_amdtp_packet(s, cycle, cip_header, payload_length, data_blocks, trace_amdtp_packet(s, cycle, cip_header, payload_length, data_blocks,
s->data_block_counter, index); data_block_counter, index);
if (!(s->flags & CIP_DBC_IS_END_EVENT)) {
s->data_block_counter =
(s->data_block_counter + data_blocks) & 0xff;
}
} }
static int check_cip_header(struct amdtp_stream *s, const __be32 *buf, static int check_cip_header(struct amdtp_stream *s, const __be32 *buf,
...@@ -709,6 +700,7 @@ static void out_stream_callback(struct fw_iso_context *context, u32 tstamp, ...@@ -709,6 +700,7 @@ static void out_stream_callback(struct fw_iso_context *context, u32 tstamp,
u32 cycle; u32 cycle;
unsigned int syt; unsigned int syt;
unsigned int data_blocks; unsigned int data_blocks;
unsigned int dbc;
__be32 *buffer; __be32 *buffer;
unsigned int pcm_frames; unsigned int pcm_frames;
struct { struct {
...@@ -721,11 +713,20 @@ static void out_stream_callback(struct fw_iso_context *context, u32 tstamp, ...@@ -721,11 +713,20 @@ static void out_stream_callback(struct fw_iso_context *context, u32 tstamp,
syt = calculate_syt(s, cycle); syt = calculate_syt(s, cycle);
data_blocks = calculate_data_blocks(s, syt); data_blocks = calculate_data_blocks(s, syt);
buffer = s->buffer.packets[s->packet_index].buffer; buffer = s->buffer.packets[s->packet_index].buffer;
pcm_frames = s->process_data_blocks(s, buffer, data_blocks, dbc = s->data_block_counter;
s->data_block_counter, &syt); pcm_frames = s->process_data_blocks(s, buffer, data_blocks, dbc,
&syt);
if (s->flags & CIP_DBC_IS_END_EVENT)
dbc = (dbc + data_blocks) & 0xff;
build_it_pkt_header(s, cycle, &template.params, data_blocks, build_it_pkt_header(s, cycle, &template.params, data_blocks,
syt, i); dbc, syt, i);
if (!(s->flags & CIP_DBC_IS_END_EVENT))
dbc = (dbc + data_blocks) & 0xff;
s->data_block_counter = dbc;
if (queue_out_packet(s, &template.params) < 0) { if (queue_out_packet(s, &template.params) < 0) {
cancel_stream(s); cancel_stream(s);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment