Merge pull request #5382 from zhaowenlan1779/uds-2
service/nwm_uds: Various improvements/corrections
This commit is contained in:
commit
5241032fc5
|
@ -226,9 +226,7 @@ void NWM_UDS::HandleEAPoLPacket(const Network::WifiPacket& packet) {
|
||||||
connection_status.nodes[node_id - 1] = node.network_node_id;
|
connection_status.nodes[node_id - 1] = node.network_node_id;
|
||||||
connection_status.total_nodes++;
|
connection_status.total_nodes++;
|
||||||
|
|
||||||
u8 current_nodes = network_info.total_nodes;
|
node_info[node_id - 1] = node;
|
||||||
node_info[current_nodes] = node;
|
|
||||||
|
|
||||||
network_info.total_nodes++;
|
network_info.total_nodes++;
|
||||||
|
|
||||||
node_map[packet.transmitter_address].node_id = node.network_node_id;
|
node_map[packet.transmitter_address].node_id = node.network_node_id;
|
||||||
|
@ -268,13 +266,18 @@ void NWM_UDS::HandleEAPoLPacket(const Network::WifiPacket& packet) {
|
||||||
connection_status.max_nodes = logoff.max_nodes;
|
connection_status.max_nodes = logoff.max_nodes;
|
||||||
|
|
||||||
node_info.clear();
|
node_info.clear();
|
||||||
node_info.reserve(network_info.max_nodes);
|
node_info.resize(network_info.max_nodes);
|
||||||
for (std::size_t index = 0; index < logoff.connected_nodes; ++index) {
|
for (const auto& node : logoff.nodes) {
|
||||||
connection_status.node_bitmask |= 1 << index;
|
const u16 index = node.network_node_id;
|
||||||
connection_status.changed_nodes |= 1 << index;
|
if (!index) {
|
||||||
connection_status.nodes[index] = logoff.nodes[index].network_node_id;
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
node_info.emplace_back(DeserializeNodeInfo(logoff.nodes[index]));
|
connection_status.node_bitmask |= 1 << (index - 1);
|
||||||
|
connection_status.changed_nodes |= 1 << (index - 1);
|
||||||
|
connection_status.nodes[index - 1] = index;
|
||||||
|
|
||||||
|
node_info[index - 1] = DeserializeNodeInfo(node);
|
||||||
}
|
}
|
||||||
|
|
||||||
// We're now connected, signal the application
|
// We're now connected, signal the application
|
||||||
|
@ -294,17 +297,26 @@ void NWM_UDS::HandleEAPoLPacket(const Network::WifiPacket& packet) {
|
||||||
|
|
||||||
network_info.total_nodes = logoff.connected_nodes;
|
network_info.total_nodes = logoff.connected_nodes;
|
||||||
connection_status.total_nodes = logoff.connected_nodes;
|
connection_status.total_nodes = logoff.connected_nodes;
|
||||||
|
std::memset(connection_status.nodes, 0, sizeof(connection_status.nodes));
|
||||||
|
|
||||||
|
const auto old_bitmask = connection_status.node_bitmask;
|
||||||
|
connection_status.node_bitmask = 0;
|
||||||
|
|
||||||
node_info.clear();
|
node_info.clear();
|
||||||
node_info.reserve(network_info.max_nodes);
|
node_info.resize(network_info.max_nodes);
|
||||||
for (std::size_t index = 0; index < logoff.connected_nodes; ++index) {
|
for (const auto& node : logoff.nodes) {
|
||||||
if ((connection_status.node_bitmask & (1 << index)) == 0) {
|
const u16 index = node.network_node_id;
|
||||||
connection_status.changed_nodes |= 1 << index;
|
if (!index) {
|
||||||
|
continue;
|
||||||
}
|
}
|
||||||
connection_status.nodes[index] = logoff.nodes[index].network_node_id;
|
|
||||||
connection_status.node_bitmask |= 1 << index;
|
connection_status.node_bitmask |= 1 << (index - 1);
|
||||||
node_info.emplace_back(DeserializeNodeInfo(logoff.nodes[index]));
|
connection_status.nodes[index - 1] = index;
|
||||||
|
|
||||||
|
node_info[index - 1] = DeserializeNodeInfo(node);
|
||||||
}
|
}
|
||||||
|
connection_status.changed_nodes = old_bitmask ^ connection_status.node_bitmask;
|
||||||
|
|
||||||
connection_status_event->Signal();
|
connection_status_event->Signal();
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -333,9 +345,11 @@ void NWM_UDS::HandleSecureDataPacket(const Network::WifiPacket& packet) {
|
||||||
// The packet wasn't addressed to us, we can only act as a router if we're the host.
|
// The packet wasn't addressed to us, we can only act as a router if we're the host.
|
||||||
// However, we might have received this packet due to a broadcast from the host, in that
|
// However, we might have received this packet due to a broadcast from the host, in that
|
||||||
// case just ignore it.
|
// case just ignore it.
|
||||||
ASSERT_MSG(packet.destination_address == Network::BroadcastMac ||
|
if (packet.destination_address != Network::BroadcastMac &&
|
||||||
connection_status.status == static_cast<u32>(NetworkStatus::ConnectedAsHost),
|
connection_status.status != static_cast<u32>(NetworkStatus::ConnectedAsHost)) {
|
||||||
"Can't be a router if we're not a host");
|
LOG_ERROR(Service_NWM, "Received packet addressed to others but we're not a host");
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
if (connection_status.status == static_cast<u32>(NetworkStatus::ConnectedAsHost) &&
|
if (connection_status.status == static_cast<u32>(NetworkStatus::ConnectedAsHost) &&
|
||||||
secure_data.dest_node_id != BroadcastNetworkNodeId) {
|
secure_data.dest_node_id != BroadcastNetworkNodeId) {
|
||||||
|
|
|
@ -354,7 +354,7 @@ std::vector<u8> GenerateEAPoLLogoffFrame(const MacAddress& mac_address, u16 netw
|
||||||
eapol_logoff.connected_nodes = total_nodes;
|
eapol_logoff.connected_nodes = total_nodes;
|
||||||
eapol_logoff.max_nodes = max_nodes;
|
eapol_logoff.max_nodes = max_nodes;
|
||||||
|
|
||||||
for (std::size_t index = 0; index < total_nodes; ++index) {
|
for (std::size_t index = 0; index < max_nodes; ++index) {
|
||||||
const auto& node_info = nodes[index];
|
const auto& node_info = nodes[index];
|
||||||
auto& node = eapol_logoff.nodes[index];
|
auto& node = eapol_logoff.nodes[index];
|
||||||
|
|
||||||
|
|
Reference in New Issue