int aecp_controller_state_machine::proc_resp(void *& notification_id, struct jdksavdecc_frame * cmd_frame)
{
uint16_t seq_id = jdksavdecc_aecpdu_common_get_sequence_id(cmd_frame->payload, ETHER_HDR_SIZE);
uint32_t status = jdksavdecc_common_control_header_get_status(cmd_frame->payload, ETHER_HDR_SIZE);
uint32_t notification_flag = 0;
std::vector<inflight>::iterator j =
std::find_if(inflight_cmds.begin(), inflight_cmds.end(), SeqIdComp(seq_id));
if (j != inflight_cmds.end()) // found?
{
notification_id = j->cmd_notification_id;
notification_flag = j->notification_flag();
callback(notification_id, notification_flag, cmd_frame->payload);
// Restart the timer if response is indicating the operation is still in progress so that it won't be timed out
if (status == AEM_STATUS_IN_PROGRESS)
{
j->restart_timer();
}
else
{
inflight_cmds.erase(j);
}
return 1;
}
return -1;
}
ssize_t jdksavdecc_common_control_header_read( struct jdksavdecc_common_control_header *p,
void const *base,
ssize_t pos,
size_t len )
{
ssize_t r = jdksavdecc_validate_range( pos, len, JDKSAVDECC_COMMON_CONTROL_HEADER_LEN );
if ( r >= 0 )
{
p->cd = jdksavdecc_common_control_header_get_cd( base, pos );
p->subtype = jdksavdecc_common_control_header_get_subtype( base, pos );
p->sv = jdksavdecc_common_control_header_get_sv( base, pos );
p->version = jdksavdecc_common_control_header_get_version( base, pos );
p->control_data = jdksavdecc_common_control_header_get_control_data( base, pos );
p->status = jdksavdecc_common_control_header_get_status( base, pos );
p->control_data_length = jdksavdecc_common_control_header_get_control_data_length( base, pos );
p->stream_id = jdksavdecc_common_control_header_get_stream_id( base, pos );
}
return r;
}
int aecp_controller_state_machine::callback(void *notification_id, uint32_t notification_flag, uint8_t *frame)
{
uint32_t msg_type = jdksavdecc_common_control_header_get_control_data(frame, ETHER_HDR_SIZE);
uint16_t cmd_type = jdksavdecc_aecpdu_aem_get_command_type(frame, ETHER_HDR_SIZE);
cmd_type &= 0x7FFF;
uint32_t status = jdksavdecc_common_control_header_get_status(frame, ETHER_HDR_SIZE);
uint16_t desc_type = 0;
uint16_t desc_index = 0;
switch(cmd_type)
{
case JDKSAVDECC_AEM_COMMAND_ACQUIRE_ENTITY:
desc_type = jdksavdecc_aem_command_acquire_entity_response_get_descriptor_type(frame, ETHER_HDR_SIZE);
desc_index = jdksavdecc_aem_command_acquire_entity_response_get_descriptor_index(frame, ETHER_HDR_SIZE);
break;
case JDKSAVDECC_AEM_COMMAND_LOCK_ENTITY:
desc_type = jdksavdecc_aem_command_lock_entity_get_descriptor_type(frame, ETHER_HDR_SIZE);
desc_index = jdksavdecc_aem_command_lock_entity_get_descriptor_index(frame, ETHER_HDR_SIZE);
break;
case JDKSAVDECC_AEM_COMMAND_ENTITY_AVAILABLE:
break;
case JDKSAVDECC_AEM_COMMAND_CONTROLLER_AVAILABLE:
break;
case JDKSAVDECC_AEM_COMMAND_READ_DESCRIPTOR:
desc_type = jdksavdecc_aem_command_read_descriptor_get_descriptor_type(frame, ETHER_HDR_SIZE);
desc_index = jdksavdecc_aem_command_read_descriptor_get_descriptor_index(frame, ETHER_HDR_SIZE);
break;
case JDKSAVDECC_AEM_COMMAND_SET_STREAM_FORMAT:
desc_type = jdksavdecc_aem_command_set_stream_format_response_get_descriptor_type(frame, ETHER_HDR_SIZE);
desc_index = jdksavdecc_aem_command_set_stream_format_response_get_descriptor_index(frame, ETHER_HDR_SIZE);
break;
case JDKSAVDECC_AEM_COMMAND_GET_STREAM_FORMAT:
desc_type = jdksavdecc_aem_command_get_stream_format_response_get_descriptor_type(frame, ETHER_HDR_SIZE);
desc_index = jdksavdecc_aem_command_get_stream_format_response_get_descriptor_index(frame, ETHER_HDR_SIZE);
break;
case JDKSAVDECC_AEM_COMMAND_SET_STREAM_INFO:
desc_type = jdksavdecc_aem_command_set_stream_info_response_get_descriptor_type(frame, ETHER_HDR_SIZE);
desc_index = jdksavdecc_aem_command_set_stream_info_response_get_descriptor_index(frame, ETHER_HDR_SIZE);
break;
case JDKSAVDECC_AEM_COMMAND_GET_STREAM_INFO:
desc_type = jdksavdecc_aem_command_get_stream_info_response_get_descriptor_type(frame, ETHER_HDR_SIZE);
desc_index = jdksavdecc_aem_command_get_stream_info_response_get_descriptor_index(frame, ETHER_HDR_SIZE);
break;
case JDKSAVDECC_AEM_COMMAND_SET_NAME:
desc_type = jdksavdecc_aem_command_set_name_response_get_descriptor_type(frame, ETHER_HDR_SIZE);
desc_index = jdksavdecc_aem_command_set_name_response_get_descriptor_index(frame, ETHER_HDR_SIZE);
break;
case JDKSAVDECC_AEM_COMMAND_GET_NAME:
desc_type = jdksavdecc_aem_command_get_name_response_get_descriptor_type(frame, ETHER_HDR_SIZE);
desc_index = jdksavdecc_aem_command_get_name_response_get_descriptor_index(frame, ETHER_HDR_SIZE);
break;
case JDKSAVDECC_AEM_COMMAND_SET_SAMPLING_RATE:
desc_type = jdksavdecc_aem_command_set_sampling_rate_response_get_descriptor_type(frame, ETHER_HDR_SIZE);
desc_index = jdksavdecc_aem_command_set_sampling_rate_response_get_descriptor_index(frame, ETHER_HDR_SIZE);
break;
case JDKSAVDECC_AEM_COMMAND_GET_SAMPLING_RATE:
desc_type = jdksavdecc_aem_command_get_sampling_rate_response_get_descriptor_type(frame, ETHER_HDR_SIZE);
desc_index = jdksavdecc_aem_command_get_sampling_rate_response_get_descriptor_index(frame, ETHER_HDR_SIZE);
break;
case JDKSAVDECC_AEM_COMMAND_SET_CLOCK_SOURCE:
desc_type = jdksavdecc_aem_command_set_clock_source_response_get_descriptor_type(frame, ETHER_HDR_SIZE);
desc_index = jdksavdecc_aem_command_set_clock_source_response_get_descriptor_index(frame, ETHER_HDR_SIZE);
break;
case JDKSAVDECC_AEM_COMMAND_GET_CLOCK_SOURCE:
desc_type = jdksavdecc_aem_command_get_clock_source_response_get_descriptor_type(frame, ETHER_HDR_SIZE);
desc_index = jdksavdecc_aem_command_get_clock_source_response_get_descriptor_index(frame, ETHER_HDR_SIZE);
break;
case JDKSAVDECC_AEM_COMMAND_START_STREAMING:
desc_type = jdksavdecc_aem_command_start_streaming_response_get_descriptor_type(frame, ETHER_HDR_SIZE);
desc_index = jdksavdecc_aem_command_start_streaming_response_get_descriptor_index(frame, ETHER_HDR_SIZE);
break;
case JDKSAVDECC_AEM_COMMAND_STOP_STREAMING:
desc_type = jdksavdecc_aem_command_stop_streaming_response_get_descriptor_type(frame, ETHER_HDR_SIZE);
desc_index = jdksavdecc_aem_command_stop_streaming_response_get_descriptor_index(frame, ETHER_HDR_SIZE);
break;
case JDKSAVDECC_AEM_COMMAND_GET_COUNTERS:
desc_type = jdksavdecc_aem_command_get_counters_response_get_descriptor_type(frame, ETHER_HDR_SIZE);
desc_index = jdksavdecc_aem_command_get_counters_response_get_descriptor_index(frame, ETHER_HDR_SIZE);
break;
case JDKSAVDECC_AEM_COMMAND_REGISTER_UNSOLICITED_NOTIFICATION:
break;
default:
log_imp_ref->post_log_msg(LOGGING_LEVEL_DEBUG, "NO_MATCH_FOUND for %s", utility::aem_cmd_value_to_name(cmd_type));
break;
}
jdksavdecc_eui64 id = jdksavdecc_common_control_header_get_stream_id(frame, ETHER_HDR_SIZE);
if((notification_flag == CMD_WITH_NOTIFICATION) &&
((msg_type == JDKSAVDECC_AECP_MESSAGE_TYPE_AEM_RESPONSE) ||
(msg_type == JDKSAVDECC_AECP_MESSAGE_TYPE_ADDRESS_ACCESS_RESPONSE)))
{
notification_imp_ref->post_notification_msg(RESPONSE_RECEIVED,
jdksavdecc_uint64_get(&id, 0),
cmd_type,
desc_type,
desc_index,
status,
notification_id);
if(status != AEM_STATUS_SUCCESS)
{
log_imp_ref->post_log_msg(LOGGING_LEVEL_ERROR,
"RESPONSE_RECEIVED, 0x%llx, %s, %s, %d, %d, %s",
jdksavdecc_uint64_get(&id, 0),
utility::aem_cmd_value_to_name(cmd_type),
utility::aem_desc_value_to_name(desc_type),
desc_index,
jdksavdecc_aecpdu_common_get_sequence_id(frame, ETHER_HDR_SIZE),
utility::aem_cmd_status_value_to_name(status));
}
}
else if(((notification_flag == CMD_WITH_NOTIFICATION) || (notification_flag == CMD_WITHOUT_NOTIFICATION)) &&
((msg_type == JDKSAVDECC_AECP_MESSAGE_TYPE_AEM_COMMAND) || (msg_type == JDKSAVDECC_AECP_MESSAGE_TYPE_ADDRESS_ACCESS_COMMAND)))
{
log_imp_ref->post_log_msg(LOGGING_LEVEL_DEBUG,
"COMMAND_SENT, 0x%llx, %s, %s, %d, %d",
jdksavdecc_uint64_get(&id, 0),
utility::aem_cmd_value_to_name(cmd_type),
utility::aem_desc_value_to_name(desc_type),
desc_index,
jdksavdecc_aecpdu_common_get_sequence_id(frame, ETHER_HDR_SIZE));
}
else if((notification_flag == CMD_WITHOUT_NOTIFICATION) &&
((msg_type == JDKSAVDECC_AECP_MESSAGE_TYPE_AEM_RESPONSE) ||
(msg_type == JDKSAVDECC_AECP_MESSAGE_TYPE_ADDRESS_ACCESS_RESPONSE)))
{
if(status == AEM_STATUS_SUCCESS)
{
log_imp_ref->post_log_msg(LOGGING_LEVEL_DEBUG,
"RESPONSE_RECEIVED, 0x%llx, %s, %s, %d, %d, %s",
jdksavdecc_uint64_get(&id, 0),
utility::aem_cmd_value_to_name(cmd_type),
utility::aem_desc_value_to_name(desc_type),
desc_index,
jdksavdecc_aecpdu_common_get_sequence_id(frame, ETHER_HDR_SIZE),
utility::aem_cmd_status_value_to_name(status));
}
else
{
log_imp_ref->post_log_msg(LOGGING_LEVEL_ERROR,
"RESPONSE_RECEIVED, 0x%llx, %s, %s, %d, %d, %s",
jdksavdecc_uint64_get(&id, 0),
utility::aem_cmd_value_to_name(cmd_type),
utility::aem_desc_value_to_name(desc_type),
desc_index,
jdksavdecc_aecpdu_common_get_sequence_id(frame, ETHER_HDR_SIZE),
utility::aem_cmd_status_value_to_name(status));
}
}
return 0;
}
void jdksavdecc_pdu_print( struct jdksavdecc_printer *self, const uint8_t *p, size_t len, int dump_payload )
{
if ( len > 12 )
{
int cd = jdksavdecc_common_control_header_get_cd( p, 0 );
uint8_t version = (uint8_t)jdksavdecc_common_control_header_get_version( p, 0 );
jdksavdecc_printer_print_label( self, "version" );
jdksavdecc_printer_print_uint8( self, version );
jdksavdecc_printer_print_eol( self );
jdksavdecc_printer_print_label( self, "cd and subtype" );
jdksavdecc_printer_print_uint16_name( self, jdksavdecc_pdu_print_cd_subtype, p[0] );
jdksavdecc_printer_print_eol( self );
if ( version == 0 )
{
jdksavdecc_printer_print_label( self, "sv" );
if ( jdksavdecc_common_control_header_get_sv( p, 0 ) )
{
jdksavdecc_printer_print( self, "valid" );
}
else
{
jdksavdecc_printer_print( self, "not valid" );
}
jdksavdecc_printer_print_eol( self );
if ( cd == 0 ) // version 0 stream data
{
jdksavdecc_printer_print_label( self, "mr" );
jdksavdecc_printer_print_uint8( self, (uint8_t)jdksavdecc_common_stream_header_get_mr( p, 0 ) );
jdksavdecc_printer_print_eol( self );
jdksavdecc_printer_print_label( self, "gv" );
jdksavdecc_printer_print_uint8( self, (uint8_t)jdksavdecc_common_stream_header_get_gv( p, 0 ) );
jdksavdecc_printer_print_eol( self );
jdksavdecc_printer_print_label( self, "tv" );
jdksavdecc_printer_print_uint8( self, (uint8_t)jdksavdecc_common_stream_header_get_tv( p, 0 ) );
jdksavdecc_printer_print_eol( self );
jdksavdecc_printer_print_label( self, "sequence_num" );
jdksavdecc_printer_print_uint8( self, (uint8_t)jdksavdecc_common_stream_header_get_sequence_num( p, 0 ) );
jdksavdecc_printer_print_eol( self );
jdksavdecc_printer_print_label( self, "tu" );
jdksavdecc_printer_print_uint8( self, (uint8_t)jdksavdecc_common_stream_header_get_tu( p, 0 ) );
jdksavdecc_printer_print_eol( self );
jdksavdecc_printer_print_label( self, "stream_id" );
jdksavdecc_printer_print_streamid( self, jdksavdecc_common_stream_header_get_stream_id( p, 0 ) );
jdksavdecc_printer_print_eol( self );
jdksavdecc_printer_print_label( self, "avtp_timestamp" );
jdksavdecc_printer_print_uint32( self, jdksavdecc_common_stream_header_get_avtp_timestamp( p, 0 ) );
jdksavdecc_printer_print_eol( self );
jdksavdecc_printer_print_label( self, "gateway_info" );
jdksavdecc_printer_print_uint32( self, jdksavdecc_common_stream_header_get_gateway_info( p, 0 ) );
jdksavdecc_printer_print_eol( self );
jdksavdecc_printer_print_label( self, "stream_data_length" );
jdksavdecc_printer_print_uint16( self, jdksavdecc_common_stream_header_get_stream_data_length( p, 0 ) );
jdksavdecc_printer_print_eol( self );
jdksavdecc_printer_print_label( self, "protocol_specific_header" );
jdksavdecc_printer_print_uint16( self, jdksavdecc_common_stream_header_get_protocol_specific_header( p, 0 ) );
jdksavdecc_printer_print_eol( self );
if ( dump_payload && len > JDKSAVDECC_COMMON_STREAM_HEADER_LEN )
{
jdksavdecc_printer_print_label( self, "stream_data_payload" );
jdksavdecc_printer_print_block( self, p, len, JDKSAVDECC_COMMON_STREAM_HEADER_LEN, len );
}
}
else // version 0 control data
{
jdksavdecc_printer_print_label( self, "control_data" );
jdksavdecc_printer_print_uint8( self, (uint8_t)jdksavdecc_common_control_header_get_control_data( p, 0 ) );
jdksavdecc_printer_print_eol( self );
jdksavdecc_printer_print_label( self, "status" );
jdksavdecc_printer_print_uint8( self, (uint8_t)jdksavdecc_common_control_header_get_status( p, 0 ) );
jdksavdecc_printer_print_eol( self );
jdksavdecc_printer_print_label( self, "control_data_length" );
jdksavdecc_printer_print_uint16( self,
(uint16_t)jdksavdecc_common_control_header_get_control_data_length( p, 0 ) );
jdksavdecc_printer_print_eol( self );
jdksavdecc_printer_print_label( self, "stream_id" );
jdksavdecc_printer_print_streamid( self, jdksavdecc_common_control_header_get_stream_id( p, 0 ) );
jdksavdecc_printer_print_eol( self );
}
if ( dump_payload && len > JDKSAVDECC_COMMON_CONTROL_HEADER_LEN )
{
jdksavdecc_printer_print_label( self, "payload" );
jdksavdecc_printer_print_block( self, p, len, JDKSAVDECC_COMMON_CONTROL_HEADER_LEN, len );
}
}
}
}
int acmp_callback( uint32_t notification_flag, uint8_t *frame, uint16_t frame_len )
{
uint32_t msg_type = jdksavdecc_common_control_header_get_control_data(frame, ZERO_OFFSET_IN_PAYLOAD);
uint16_t seq_id = jdksavdecc_acmpdu_get_sequence_id(frame, ZERO_OFFSET_IN_PAYLOAD);
uint32_t status = jdksavdecc_common_control_header_get_status(frame, ZERO_OFFSET_IN_PAYLOAD);
uint64_t end_station_entity_id;
struct jdksavdecc_eui64 stream_entity_station = jdksavdecc_common_control_header_get_stream_id( frame, ZERO_OFFSET_IN_PAYLOAD );
uint64_t end_stream_id = jdksavdecc_uint64_get(&stream_entity_station, 0);
subject_data_elem elem;
// acmp info
struct jdksavdecc_acmpdu node_acmpdu;
jdksavdecc_acmpdu_read( &node_acmpdu, frame, ZERO_OFFSET_IN_PAYLOAD, frame_len );
if((notification_flag == CMD_WITH_NOTIFICATION) &&
((msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_GET_TX_STATE_RESPONSE) ||
(msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_GET_TX_CONNECTION_RESPONSE)))
{
struct jdksavdecc_eui64 _end_station_entity_id = jdksavdecc_acmpdu_get_talker_entity_id(frame, ZERO_OFFSET_IN_PAYLOAD);
struct jdksavdecc_eui64 listener_entity = jdksavdecc_acmpdu_get_listener_entity_id(frame, ZERO_OFFSET_IN_PAYLOAD);
end_station_entity_id = jdksavdecc_uint64_get(&_end_station_entity_id, 0);
uint64_t listener_id = jdksavdecc_uint64_get(&listener_entity, 0);
if (status == ACMP_STATUS_SUCCESS)
{
if (NULL != gp_log_imp)
gp_log_imp->log.post_log_msg( &gp_log_imp->log,
LOGGING_LEVEL_DEBUG,
" [ RESPONSE_RECEIVED: %d 0x%016llx (talker), %d, %d, %d, %s ]",
RESPONSE_RECEIVED,
end_station_entity_id,
(uint16_t)msg_type + CMD_LOOKUP,
0,
0,
acmp_cmd_status_value_to_name(status));
}
else
{
if (NULL != gp_log_imp)
gp_log_imp->log.post_log_msg( &gp_log_imp->log,
LOGGING_LEVEL_ERROR,
"[ RESPONSE_RECEIVED, 0x%016llx (talker), %s, %s, %s, %s, %d ]",
end_station_entity_id,
acmp_cmd_value_to_name(msg_type),
"NULL",
"NULL",
acmp_cmd_status_value_to_name(status),
seq_id );
acmp_recv_resp_err = true;
}
// add notification of get_tx_state command to obserber
if (msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_GET_TX_STATE_RESPONSE)
{
subject_data_elem elem;
elem.listener_id = listener_id;
elem.listener_index = node_acmpdu.listener_unique_id;
elem.tarker_id = end_stream_id;
elem.tarker_index = node_acmpdu.talker_unique_id;
elem.ctrl_msg.data_type = JDKSAVDECC_SUBTYPE_ACMP;
elem.ctrl_msg.msg_type = msg_type;
elem.ctrl_msg.msg_resp_status = status;// -1 means timeout status.
elem.data_frame = NULL;// set data frame
elem.data_frame_len = 0;
set_subject_data( elem, &gconnector_subjector );
notify_observer( &gconnector_subjector );
}
}
else if((notification_flag == CMD_WITH_NOTIFICATION) &&
((msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_CONNECT_RX_RESPONSE) ||
(msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_DISCONNECT_RX_RESPONSE) ||
(msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_GET_RX_STATE_RESPONSE)))
{
struct jdksavdecc_eui64 _end_station_entity_id = jdksavdecc_acmpdu_get_listener_entity_id( frame, ZERO_OFFSET_IN_PAYLOAD );
struct jdksavdecc_eui64 _tarker_id = jdksavdecc_acmpdu_get_talker_entity_id( frame, ZERO_OFFSET_IN_PAYLOAD );
uint64_t tarker_id = jdksavdecc_uint64_get( &_tarker_id, 0 );
end_station_entity_id = jdksavdecc_uint64_get(&_end_station_entity_id, 0);
if( (status == ACMP_STATUS_SUCCESS) &&\
((msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_CONNECT_RX_RESPONSE) || \
(msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_DISCONNECT_RX_RESPONSE)))// udpate system descriptor connect list
{
if (NULL != gp_log_imp)
gp_log_imp->log.post_log_msg( &gp_log_imp->log,
LOGGING_LEVEL_DEBUG,
" [ RESPONSE_RECEIVED: %d 0x%016llx (listener)-0x%016llx(tarker), %d, %d, %d, %s ]",
RESPONSE_RECEIVED,
end_station_entity_id,
tarker_id,
(uint16_t)msg_type + CMD_LOOKUP,
0,
0,
acmp_cmd_status_value_to_name(status));
elem.connect_flag = (msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_CONNECT_RX_RESPONSE)?true:false;
elem.listener_id = end_station_entity_id;
elem.listener_index = node_acmpdu.listener_unique_id;
elem.tarker_id = tarker_id;
elem.tarker_index = node_acmpdu.talker_unique_id;
elem.ctrl_msg.data_type = JDKSAVDECC_SUBTYPE_ACMP;
elem.ctrl_msg.msg_type = msg_type;
elem.ctrl_msg.msg_resp_status = status;
elem.data_frame = NULL;// set data frame
elem.data_frame_len = 0;
set_subject_data( elem, &gconnector_subjector );
notify_observer( &gconnector_subjector );
}
else if( (status == ACMP_STATUS_SUCCESS) && \
(msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_GET_RX_STATE_RESPONSE))
{
if (NULL != gp_log_imp)
gp_log_imp->log.post_log_msg( &gp_log_imp->log,
LOGGING_LEVEL_DEBUG,
"[ RESPONSE_RECEIVED: %d 0x%016llx (listener), %d, %d, %d, %s ]",
RESPONSE_RECEIVED,
end_station_entity_id,
(uint16_t)msg_type + CMD_LOOKUP,
0,
0,
acmp_cmd_status_value_to_name(status));
elem.listener_id = end_station_entity_id;
elem.listener_index = node_acmpdu.listener_unique_id;
elem.tarker_id = tarker_id;
elem.tarker_index = node_acmpdu.talker_unique_id;
elem.ctrl_msg.data_type = JDKSAVDECC_SUBTYPE_ACMP;
elem.ctrl_msg.msg_type = msg_type;
elem.ctrl_msg.msg_resp_status = status;
elem.data_frame = NULL;// set data frame
elem.data_frame_len = 0;
set_subject_data( elem, &gconnector_subjector );
notify_observer( &gconnector_subjector );
}
else if( status != ACMP_STATUS_SUCCESS )
{
if (NULL != gp_log_imp)
gp_log_imp->log.post_log_msg( &gp_log_imp->log,
LOGGING_LEVEL_ERROR,
"[ 0x%016llx (listener), %s, %s, %s, %s, %d ]",
end_station_entity_id,
acmp_cmd_value_to_name(msg_type),
"NULL",
"NULL",
acmp_cmd_status_value_to_name(status),
seq_id);
elem.connect_flag = false;
elem.listener_id = end_station_entity_id;
elem.listener_index = node_acmpdu.listener_unique_id;
elem.tarker_id = tarker_id;
elem.tarker_index = node_acmpdu.talker_unique_id;
elem.ctrl_msg.data_type = JDKSAVDECC_SUBTYPE_ACMP;
elem.ctrl_msg.msg_type = msg_type;
elem.ctrl_msg.msg_resp_status = status;
elem.data_frame = NULL;// set data frame
elem.data_frame_len = 0;
set_subject_data( elem, &gconnector_subjector );
notify_observer( &gconnector_subjector );
acmp_recv_resp_err = true;
}
}
else if((msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_GET_TX_STATE_RESPONSE) ||
(msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_GET_TX_CONNECTION_RESPONSE))
{
struct jdksavdecc_eui64 _end_station_entity_id = jdksavdecc_acmpdu_get_talker_entity_id(frame, ZERO_OFFSET_IN_PAYLOAD);
end_station_entity_id = jdksavdecc_uint64_get(&_end_station_entity_id, 0);
gp_log_imp->log.post_log_msg( &gp_log_imp->log,
LOGGING_LEVEL_DEBUG,
"[RESPONSE_RECEIVED, 0x%016llx (talker), %s, %s, %s, %s, %d]",
end_station_entity_id,
acmp_cmd_value_to_name(msg_type),
"NULL",
"NULL",
acmp_cmd_status_value_to_name(status),
seq_id);
}
else
{
struct jdksavdecc_eui64 _end_station_entity_id = jdksavdecc_acmpdu_get_listener_entity_id(frame, ZERO_OFFSET_IN_PAYLOAD);
end_station_entity_id = jdksavdecc_uint64_get(&_end_station_entity_id, 0);
if (NULL != gp_log_imp)
gp_log_imp->log.post_log_msg( &gp_log_imp->log,
LOGGING_LEVEL_DEBUG,
"[ COMMAND_SENT, 0x%016llx listener, %s, %s, %s, %s, %d ]",
end_station_entity_id,
acmp_cmd_value_to_name(msg_type),
"NULL",
"NULL",
acmp_cmd_status_value_to_name(status),
seq_id );
}
return 0;
}
int acmp_controller_state_machine::callback(void *notification_id, uint32_t notification_flag, uint8_t *frame)
{
uint32_t msg_type = jdksavdecc_common_control_header_get_control_data(frame, ETHER_HDR_SIZE);
uint16_t seq_id = jdksavdecc_acmpdu_get_sequence_id(frame, ETHER_HDR_SIZE);
uint32_t status = jdksavdecc_common_control_header_get_status(frame, ETHER_HDR_SIZE);
uint64_t end_station_entity_id;
if((notification_flag == CMD_WITH_NOTIFICATION) &&
((msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_GET_TX_STATE_RESPONSE) ||
(msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_GET_TX_CONNECTION_RESPONSE)))
{
struct jdksavdecc_eui64 _end_station_entity_id = jdksavdecc_acmpdu_get_talker_entity_id(frame, ETHER_HDR_SIZE);
end_station_entity_id = jdksavdecc_uint64_get(&_end_station_entity_id, 0);
notification_imp_ref->post_notification_msg(RESPONSE_RECEIVED,
end_station_entity_id,
(uint16_t)msg_type + CMD_LOOKUP,
0,
0,
status,
notification_id);
if(status != ACMP_STATUS_SUCCESS)
{
log_imp_ref->post_log_msg(LOGGING_LEVEL_ERROR,
"RESPONSE_RECEIVED, 0x%llx, %s, %s, %s, %s, %d",
end_station_entity_id,
utility->acmp_cmd_value_to_name(msg_type),
"NULL",
"NULL",
utility->acmp_cmd_status_value_to_name(status),
seq_id);
}
}
else if((notification_flag == CMD_WITH_NOTIFICATION) &&
((msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_CONNECT_RX_RESPONSE) ||
(msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_DISCONNECT_RX_RESPONSE) ||
(msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_GET_RX_STATE_RESPONSE) ||
(msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_GET_RX_STATE_RESPONSE)))
{
struct jdksavdecc_eui64 _end_station_entity_id = jdksavdecc_acmpdu_get_listener_entity_id(frame, ETHER_HDR_SIZE);
end_station_entity_id = jdksavdecc_uint64_get(&_end_station_entity_id, 0);
notification_imp_ref->post_notification_msg(RESPONSE_RECEIVED,
end_station_entity_id,
(uint16_t)msg_type + CMD_LOOKUP,
0,
0,
status,
notification_id);
if(status != ACMP_STATUS_SUCCESS)
{
log_imp_ref->post_log_msg(LOGGING_LEVEL_ERROR,
"RESPONSE_RECEIVED, 0x%llx, %s, %s, %s, %s, %d",
end_station_entity_id,
utility->acmp_cmd_value_to_name(msg_type),
"NULL",
"NULL",
utility->acmp_cmd_status_value_to_name(status),
seq_id);
}
}
else if((msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_GET_TX_STATE_RESPONSE) ||
(msg_type == JDKSAVDECC_ACMP_MESSAGE_TYPE_GET_TX_CONNECTION_RESPONSE))
{
struct jdksavdecc_eui64 _end_station_entity_id = jdksavdecc_acmpdu_get_talker_entity_id(frame, ETHER_HDR_SIZE);
end_station_entity_id = jdksavdecc_uint64_get(&_end_station_entity_id, 0);
log_imp_ref->post_log_msg(LOGGING_LEVEL_DEBUG,
"RESPONSE_RECEIVED, 0x%llx, %s, %s, %s, %s, %d",
end_station_entity_id,
utility->acmp_cmd_value_to_name(msg_type),
"NULL",
"NULL",
utility->acmp_cmd_status_value_to_name(status),
seq_id);
}
else
{
struct jdksavdecc_eui64 _end_station_entity_id = jdksavdecc_acmpdu_get_listener_entity_id(frame, ETHER_HDR_SIZE);
end_station_entity_id = jdksavdecc_uint64_get(&_end_station_entity_id, 0);
log_imp_ref->post_log_msg(LOGGING_LEVEL_DEBUG,
"COMMAND_SENT, 0x%llx, %s, %s, %s, %s, %d",
end_station_entity_id,
utility->acmp_cmd_value_to_name(msg_type),
"NULL",
"NULL",
utility->acmp_cmd_status_value_to_name(status),
seq_id);
}
return 0;
}
