#include #include #include #include #include #include #include #include #ifdef _WIN32 #include #else #include #endif #define TX_LOCAL_ID 0u #define RX_LOCAL_ID 1u #define T1S_MAX_NODES 8u #define T1S_TX_OPP_TIMER 20u #define T1S_BURST_TIMER 64u #define T1S_MAX_BURST 128u #define LOOPBACK_ETHER_TYPE 0x9000u #define LOOPBACK_FRAME_SIZE 60u typedef struct selectable_network { icsneoc2_netid_t netid; char name[64]; } selectable_network_t; /* Sleep for a short period while waiting for the device to apply settings. */ static void sleep_ms(uint32_t ms); /* Print a readable error string and return the same failure code to the caller. */ static int print_error_code(const char* message, icsneoc2_error_t error); /* Drain and print queued library events when the example encounters an error. */ static void print_events(void); /* Convert a netid to a readable name such as "AE 02". */ static int get_netid_name(icsneoc2_netid_t netid, char* buffer, size_t buffer_size); /* Gather the device's TX and RX networks, keeping only automotive Ethernet ports. */ static int get_available_networks(const icsneoc2_device_t* device, selectable_network_t* tx_networks, size_t* tx_count, selectable_network_t* rx_networks, size_t* rx_count); /* Prompt the user to choose one TX or RX network from the filtered list. */ static int prompt_for_network_selection(const char* label, const selectable_network_t* networks, size_t count, icsneoc2_netid_t* selected_netid, char* selected_name, size_t selected_name_size); /* Apply the small set of T1S settings needed for this two-port loopback example. */ static int configure_t1s_port(icsneoc2_device_t* device, icsneoc2_netid_t netid, uint8_t local_id); /* Print a MAC address in a compact human-readable form. */ static void print_mac(const char* label, const uint8_t* mac); /* Print payload bytes as hex for the TX echo and RX frame output. */ static void print_payload_hex(const uint8_t* data, size_t length); /* Build one recognizable Ethernet frame that both transmit and receive paths share. */ static void build_loopback_frame(uint8_t* frame_data, size_t frame_size, const char* tx_name, const char* rx_name); /* Check whether a received Ethernet frame matches the loopback frame this example sent. */ static int message_matches_loopback_frame(icsneoc2_message_t* message, const uint8_t* expected, size_t expected_length, bool* matches); /* Print the key details of an Ethernet message found during the loopback test. */ static int print_ethernet_message(icsneoc2_message_t* message, const char* direction_label); /* Transmit the loopback Ethernet frame on the selected TX port. */ static int transmit_loopback_frame(icsneoc2_device_t* device, icsneoc2_netid_t tx_netid, const char* tx_name, const char* rx_name); /* Poll until the example sees both the TX echo and the matching RX frame. */ static int poll_for_loopback_messages(icsneoc2_device_t* device, icsneoc2_netid_t tx_netid, icsneoc2_netid_t rx_netid, const char* tx_name, const char* rx_name, const uint8_t* expected_frame, size_t expected_frame_length); int main(void) { icsneoc2_device_t* device = NULL; icsneoc2_error_t res; char description[255] = {0}; char serial[64] = {0}; size_t description_length = sizeof(description); size_t serial_length = sizeof(serial); selectable_network_t available_tx_networks[128] = {0}; selectable_network_t available_rx_networks[128] = {0}; size_t available_tx_count = 0; size_t available_rx_count = 0; icsneoc2_netid_t tx_netid = 0; icsneoc2_netid_t rx_netid = 0; uint8_t expected_frame[LOOPBACK_FRAME_SIZE] = {0}; char tx_name[64] = {0}; char rx_name[64] = {0}; int status = 1; printf("RAD-Comet3 C2 T1S loopback example\n"); printf("Opening first available RAD-Comet3...\n"); res = icsneoc2_device_open_first(icsneoc2_devicetype_rad_comet3, icsneoc2_open_options_default, &device); if(res != icsneoc2_error_success) { return print_error_code("Failed to open a RAD-Comet3", res); } res = icsneoc2_device_description_get(device, description, &description_length); if(res != icsneoc2_error_success) { print_error_code("Failed to get device description", res); goto cleanup; } res = icsneoc2_device_serial_get(device, serial, &serial_length); if(res != icsneoc2_error_success) { print_error_code("Failed to get device serial", res); goto cleanup; } printf("Opened device: %s [%s]\n", description, serial); if(get_available_networks(device, available_tx_networks, &available_tx_count, available_rx_networks, &available_rx_count) != 0) { goto cleanup; } if(prompt_for_network_selection("TX", available_tx_networks, available_tx_count, &tx_netid, tx_name, sizeof(tx_name)) != 0) { goto cleanup; } if(prompt_for_network_selection("RX", available_rx_networks, available_rx_count, &rx_netid, rx_name, sizeof(rx_name)) != 0) { goto cleanup; } printf("Selected loopback wiring: %s connected to %s\n", tx_name, rx_name); if(tx_netid == rx_netid) { printf("TX and RX networks are the same. This example is intended for a physical loopback between two ports.\n"); goto cleanup; } // Use the same expected frame bytes for transmit and for receive-side matching. build_loopback_frame(expected_frame, sizeof(expected_frame), tx_name, rx_name); res = icsneoc2_settings_refresh(device); if(res != icsneoc2_error_success) { print_error_code("Failed to refresh device settings", res); goto cleanup; } if(configure_t1s_port(device, tx_netid, TX_LOCAL_ID) != 0) { goto cleanup; } if(configure_t1s_port(device, rx_netid, RX_LOCAL_ID) != 0) { goto cleanup; } printf("Applying T1S settings to the device.\n"); printf("Note: icsneoc2_settings_apply() persists these settings on the device.\n"); res = icsneoc2_settings_apply(device); if(res != icsneoc2_error_success) { print_error_code("Failed to apply T1S settings", res); goto cleanup; } sleep_ms(500); if(transmit_loopback_frame(device, tx_netid, tx_name, rx_name) != 0) { goto cleanup; } if(poll_for_loopback_messages(device, tx_netid, rx_netid, tx_name, rx_name, expected_frame, sizeof(expected_frame)) != 0) { print_events(); goto cleanup; } status = 0; cleanup: if(device != NULL) { res = icsneoc2_device_close(device); if(res != icsneoc2_error_success) { (void)print_error_code("Failed to close device", res); } res = icsneoc2_device_free(device); if(res != icsneoc2_error_success) { (void)print_error_code("Failed to free device", res); } } return status; } static void sleep_ms(uint32_t ms) { #ifdef _WIN32 Sleep(ms); #else usleep(ms * 1000); #endif } static int print_error_code(const char* message, icsneoc2_error_t error) { char error_str[64] = {0}; size_t error_str_len = sizeof(error_str); icsneoc2_error_t res = icsneoc2_error_code_get(error, error_str, &error_str_len); if(res != icsneoc2_error_success) { printf("%s: failed to get string for error code %u with error code %u\n", message, error, res); return (int)res; } printf("%s: \"%s\" (%u)\n", message, error_str, error); return (int)error; } static void print_events(void) { icsneoc2_event_t* events[64] = {0}; size_t count = sizeof(events) / sizeof(events[0]); for(size_t i = 0; i < count; ++i) { icsneoc2_error_t res = icsneoc2_event_get(&events[i], NULL); if(res != icsneoc2_error_success) { (void)print_error_code("Failed to get events", res); return; } if(events[i] == NULL) { count = i; break; } } for(size_t i = 0; i < count; ++i) { char description[255] = {0}; size_t description_length = sizeof(description); icsneoc2_error_t res = icsneoc2_event_description_get(events[i], description, &description_length); if(res == icsneoc2_error_success) { printf("Event %zu: %s\n", i, description); } icsneoc2_event_free(events[i]); } } static int get_netid_name(icsneoc2_netid_t netid, char* buffer, size_t buffer_size) { size_t length = buffer_size; icsneoc2_error_t res = icsneoc2_netid_name_get(netid, buffer, &length); if(res != icsneoc2_error_success) { return print_error_code("Failed to get netid name", res); } return 0; } static int get_available_networks(const icsneoc2_device_t* device, selectable_network_t* tx_networks, size_t* tx_count, selectable_network_t* rx_networks, size_t* rx_count) { icsneoc2_netid_t supported_tx_networks[128] = {0}; icsneoc2_netid_t supported_rx_networks[128] = {0}; size_t tx_supported_count = sizeof(supported_tx_networks) / sizeof(supported_tx_networks[0]); size_t rx_supported_count = sizeof(supported_rx_networks) / sizeof(supported_rx_networks[0]); icsneoc2_message_t* probe = NULL; icsneoc2_network_type_t network_type = 0; icsneoc2_error_t res = icsneoc2_device_supported_tx_networks_get(device, supported_tx_networks, &tx_supported_count); if(res != icsneoc2_error_success) { return print_error_code("Failed to get supported TX networks", res); } res = icsneoc2_device_supported_rx_networks_get(device, supported_rx_networks, &rx_supported_count); if(res != icsneoc2_error_success) { return print_error_code("Failed to get supported RX networks", res); } *tx_count = 0; *rx_count = 0; // Reuse one temporary Ethernet message to classify each netid by network type. res = icsneoc2_message_eth_create(&probe); if(res != icsneoc2_error_success) { return print_error_code("Failed to create temporary Ethernet message", res); } for(size_t i = 0; i < tx_supported_count; ++i) { res = icsneoc2_message_netid_set(probe, supported_tx_networks[i]); if(res != icsneoc2_error_success) { continue; } res = icsneoc2_message_network_type_get(probe, &network_type); if(res != icsneoc2_error_success || network_type != icsneoc2_network_type_automotive_ethernet) { continue; } tx_networks[*tx_count].netid = supported_tx_networks[i]; if(get_netid_name(supported_tx_networks[i], tx_networks[*tx_count].name, sizeof(tx_networks[*tx_count].name)) != 0) { icsneoc2_message_free(probe); return 1; } (*tx_count)++; } for(size_t i = 0; i < rx_supported_count; ++i) { res = icsneoc2_message_netid_set(probe, supported_rx_networks[i]); if(res != icsneoc2_error_success) { continue; } res = icsneoc2_message_network_type_get(probe, &network_type); if(res != icsneoc2_error_success || network_type != icsneoc2_network_type_automotive_ethernet) { continue; } rx_networks[*rx_count].netid = supported_rx_networks[i]; if(get_netid_name(supported_rx_networks[i], rx_networks[*rx_count].name, sizeof(rx_networks[*rx_count].name)) != 0) { icsneoc2_message_free(probe); return 1; } (*rx_count)++; } icsneoc2_message_free(probe); if(*tx_count == 0) { printf("No automotive Ethernet TX networks are available on this device.\n"); return 1; } if(*rx_count == 0) { printf("No automotive Ethernet RX networks are available on this device.\n"); return 1; } return 0; } static int prompt_for_network_selection(const char* label, const selectable_network_t* networks, size_t count, icsneoc2_netid_t* selected_netid, char* selected_name, size_t selected_name_size) { char input[32] = {0}; char* end_ptr = NULL; long selected_index = 0; if(!label || !networks || count == 0 || !selected_netid || !selected_name || selected_name_size == 0) { return print_error_code("Invalid network selection parameters", icsneoc2_error_invalid_parameters); } printf("Available automotive Ethernet %s networks:\n", label); for(size_t i = 0; i < count; ++i) { printf(" %zu) %s\n", i + 1, networks[i].name); } printf("Select %s network [1-%zu, default 1]: ", label, count); if(fgets(input, sizeof(input), stdin) == NULL || input[0] == '\n') { selected_index = 1; } else { selected_index = strtol(input, &end_ptr, 10); if(end_ptr == input || selected_index < 1 || (size_t)selected_index > count) { printf("Invalid selection, using %s.\n", networks[0].name); selected_index = 1; } } *selected_netid = networks[selected_index - 1].netid; strncpy(selected_name, networks[selected_index - 1].name, selected_name_size - 1); selected_name[selected_name_size - 1] = '\0'; return 0; } static int configure_t1s_port(icsneoc2_device_t* device, icsneoc2_netid_t netid, uint8_t local_id) { char netid_name[64] = {0}; icsneoc2_error_t res; bool termination = false; if(get_netid_name(netid, netid_name, sizeof(netid_name)) != 0) { return 1; } printf("Configuring %s: PLCA on, LocalID=%u, MaxNodes=%u, TxOpp=%u, BurstTimer=%u, MaxBurst=%u\n", netid_name, (unsigned)local_id, (unsigned)T1S_MAX_NODES, (unsigned)T1S_TX_OPP_TIMER, (unsigned)T1S_BURST_TIMER, (unsigned)T1S_MAX_BURST); // Keep the example explicit about the small set of T1S settings needed for loopback. res = icsneoc2_settings_t1s_plca_enabled_for_set(device, netid, true); if(res != icsneoc2_error_success) return print_error_code("Failed to enable T1S PLCA", res); res = icsneoc2_settings_t1s_local_id_set(device, netid, local_id); if(res != icsneoc2_error_success) return print_error_code("Failed to set T1S local ID", res); res = icsneoc2_settings_t1s_max_nodes_set(device, netid, T1S_MAX_NODES); if(res != icsneoc2_error_success) return print_error_code("Failed to set T1S max nodes", res); res = icsneoc2_settings_t1s_tx_opp_timer_set(device, netid, T1S_TX_OPP_TIMER); if(res != icsneoc2_error_success) return print_error_code("Failed to set T1S TX opportunity timer", res); res = icsneoc2_settings_t1s_burst_timer_set(device, netid, T1S_BURST_TIMER); if(res != icsneoc2_error_success) return print_error_code("Failed to set T1S burst timer", res); res = icsneoc2_settings_t1s_max_burst_timer_for_set(device, netid, T1S_MAX_BURST); if(res != icsneoc2_error_success) return print_error_code("Failed to set T1S max burst", res); res = icsneoc2_settings_t1s_is_termination_enabled_for(device, netid, &termination); if(res == icsneoc2_error_success) { res = icsneoc2_settings_t1s_termination_for_set(device, netid, true); if(res != icsneoc2_error_success) return print_error_code("Failed to enable T1S termination", res); } else if(res != icsneoc2_error_get_settings_failure) { return print_error_code("Failed to query T1S termination support", res); } return 0; } static void print_mac(const char* label, const uint8_t* mac) { printf("%s %02x:%02x:%02x:%02x:%02x:%02x", label, mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]); } static void print_payload_hex(const uint8_t* data, size_t length) { for(size_t i = 0; i < length; ++i) { printf("%02x", data[i]); if(i + 1 < length) { printf(" "); } } printf("\n"); } static void build_loopback_frame(uint8_t* frame_data, size_t frame_size, const char* tx_name, const char* rx_name) { const char* tx_label = tx_name ? tx_name : "TX"; const char* rx_label = rx_name ? rx_name : "RX"; // Build one recognizable Ethernet frame so the receive side can match exactly what we sent. memset(frame_data, 0, frame_size); frame_data[0] = 0x00; frame_data[1] = 0xFC; frame_data[2] = 0x70; frame_data[3] = 0x00; frame_data[4] = 0x00; frame_data[5] = 0x02; frame_data[6] = 0x00; frame_data[7] = 0xFC; frame_data[8] = 0x70; frame_data[9] = 0x00; frame_data[10] = 0x00; frame_data[11] = 0x01; frame_data[12] = (uint8_t)((LOOPBACK_ETHER_TYPE >> 8) & 0xFF); frame_data[13] = (uint8_t)(LOOPBACK_ETHER_TYPE & 0xFF); snprintf((char*)&frame_data[14], frame_size - 14, "C2 T1S loopback %s->%s", tx_label, rx_label); } static int message_matches_loopback_frame(icsneoc2_message_t* message, const uint8_t* expected, size_t expected_length, bool* matches) { uint8_t data[1600] = {0}; size_t data_length = sizeof(data); uint16_t ether_type = 0; icsneoc2_error_t res; if(!expected || !matches || expected_length < 14) { return print_error_code("Invalid loopback match output", icsneoc2_error_invalid_parameters); } *matches = false; res = icsneoc2_message_eth_ether_type_get(message, ðer_type); if(res != icsneoc2_error_success) { return print_error_code("Failed to read loopback EtherType", res); } if(ether_type != LOOPBACK_ETHER_TYPE) { return 0; } res = icsneoc2_message_data_get(message, data, &data_length); if(res != icsneoc2_error_success) { return print_error_code("Failed to read loopback frame data", res); } if(data_length < 14) { return 0; } if(data_length >= expected_length) { *matches = memcmp(data, expected, expected_length) == 0; } else { *matches = memcmp(data, expected, data_length) == 0; } return 0; } static int print_ethernet_message(icsneoc2_message_t* message, const char* direction_label) { icsneoc2_netid_t netid = 0; char netid_name[64] = {0}; uint8_t dst_mac[6] = {0}; uint8_t src_mac[6] = {0}; uint16_t ether_type = 0; icsneoc2_message_eth_t1s_flags_t t1s_flags = 0; uint8_t node_id = 0; uint8_t burst_count = 0; uint8_t symbol_type = 0; uint8_t data[1600] = {0}; size_t data_length = sizeof(data); icsneoc2_error_t res; res = icsneoc2_message_netid_get(message, &netid); if(res != icsneoc2_error_success) return print_error_code("Failed to get message netid", res); if(get_netid_name(netid, netid_name, sizeof(netid_name)) != 0) return 1; res = icsneoc2_message_data_get(message, data, &data_length); if(res != icsneoc2_error_success) return print_error_code("Failed to get Ethernet data", res); printf("%s on %s: %zu bytes\n", direction_label, netid_name, data_length); res = icsneoc2_message_eth_mac_get(message, dst_mac, src_mac); if(res == icsneoc2_error_success) { print_mac(" Dst", dst_mac); printf(" "); print_mac("Src", src_mac); printf("\n"); } res = icsneoc2_message_eth_ether_type_get(message, ðer_type); if(res == icsneoc2_error_success) { printf(" EtherType: 0x%04x\n", ether_type); } res = icsneoc2_message_eth_t1s_props_get(message, &t1s_flags, &node_id, &burst_count, &symbol_type); if(res == icsneoc2_error_success && (t1s_flags != 0 || node_id != 0 || burst_count != 0 || symbol_type != 0)) { printf(" T1S: node=%u burst=%u symbol=%u", (unsigned)node_id, (unsigned)burst_count, (unsigned)symbol_type); if(t1s_flags & ICSNEOC2_MESSAGE_ETH_T1S_FLAGS_IS_T1S_SYMBOL) printf(" [SYMBOL]"); if(t1s_flags & ICSNEOC2_MESSAGE_ETH_T1S_FLAGS_IS_T1S_BURST) printf(" [BURST]"); if(t1s_flags & ICSNEOC2_MESSAGE_ETH_T1S_FLAGS_TX_COLLISION) printf(" [TX_COLLISION]"); if(t1s_flags & ICSNEOC2_MESSAGE_ETH_T1S_FLAGS_IS_T1S_WAKE) printf(" [WAKE]"); printf("\n"); } printf(" Payload bytes: "); if(data_length > 14) { print_payload_hex(&data[14], data_length - 14); } else { printf("\n"); } return 0; } static int transmit_loopback_frame(icsneoc2_device_t* device, icsneoc2_netid_t tx_netid, const char* tx_name, const char* rx_name) { icsneoc2_message_t* message = NULL; icsneoc2_error_t res; uint8_t frame_data[LOOPBACK_FRAME_SIZE] = {0}; build_loopback_frame(frame_data, sizeof(frame_data), tx_name, rx_name); res = icsneoc2_message_eth_create(&message); if(res != icsneoc2_error_success) return print_error_code("Failed to create Ethernet message", res); res = icsneoc2_message_netid_set(message, tx_netid); if(res != icsneoc2_error_success) { icsneoc2_message_free(message); return print_error_code("Failed to set Ethernet netid", res); } res = icsneoc2_message_data_set(message, frame_data, sizeof(frame_data)); if(res != icsneoc2_error_success) { icsneoc2_message_free(message); return print_error_code("Failed to set Ethernet payload", res); } printf("Transmitting one T1S loopback frame on %s...\n", tx_name ? tx_name : "selected TX network"); res = icsneoc2_device_message_transmit(device, message); icsneoc2_message_free(message); if(res != icsneoc2_error_success) return print_error_code("Failed to transmit loopback frame", res); return 0; } static int poll_for_loopback_messages(icsneoc2_device_t* device, icsneoc2_netid_t tx_netid, icsneoc2_netid_t rx_netid, const char* tx_name, const char* rx_name, const uint8_t* expected_frame, size_t expected_frame_length) { bool saw_tx_echo = false; bool saw_rx_frame = false; printf("Polling for TX echo on %s and RX frame on %s...\n", tx_name, rx_name); for(size_t attempt = 0; attempt < 60 && !(saw_tx_echo && saw_rx_frame); ++attempt) { icsneoc2_message_t* message = NULL; icsneoc2_error_t res = icsneoc2_device_message_get(device, &message, 100); if(res != icsneoc2_error_success) { return print_error_code("Failed while polling for loopback messages", res); } if(message == NULL) { continue; } bool is_ethernet = false; bool matches_loopback = false; res = icsneoc2_message_is_ethernet(message, &is_ethernet); if(res != icsneoc2_error_success || !is_ethernet) { icsneoc2_message_free(message); continue; } icsneoc2_netid_t netid = 0; res = icsneoc2_message_netid_get(message, &netid); if(res != icsneoc2_error_success) { icsneoc2_message_free(message); return print_error_code("Failed to get polled netid", res); } if(netid != tx_netid && netid != rx_netid) { icsneoc2_message_free(message); continue; } // Ignore unrelated traffic on the selected ports and only count the frame this example transmitted. if(message_matches_loopback_frame(message, expected_frame, expected_frame_length, &matches_loopback) != 0) { icsneoc2_message_free(message); return 1; } if(!matches_loopback) { icsneoc2_message_free(message); continue; } bool is_tx = false; res = icsneoc2_message_is_transmit(message, &is_tx); if(res != icsneoc2_error_success) { icsneoc2_message_free(message); return print_error_code("Failed to determine TX status", res); } if(netid == tx_netid && is_tx && !saw_tx_echo) { if(print_ethernet_message(message, "TX echo") != 0) { icsneoc2_message_free(message); return 1; } saw_tx_echo = true; } else if(netid == rx_netid && !saw_rx_frame) { if(print_ethernet_message(message, "RX frame") != 0) { icsneoc2_message_free(message); return 1; } if(is_tx) { printf(" Note: RX port message was also marked as transmit.\n"); } saw_rx_frame = true; } icsneoc2_message_free(message); } if(!saw_tx_echo || !saw_rx_frame) { printf("Loopback incomplete: saw_tx_echo=%s, saw_rx_frame=%s\n", saw_tx_echo ? "true" : "false", saw_rx_frame ? "true" : "false"); printf("Confirm %s is physically connected to %s and both ports are configured for 10BASE-T1S.\n", tx_name, rx_name); return 1; } printf("Loopback complete: TX echo on %s and RX frame on %s were both observed.\n", tx_name, rx_name); return 0; }