Function update_joint_state_map 

pub fn update_joint_state_map<const N: usize>(
    map: &JointStateMap,
    names: &[&str],
    state: &ArmState<N>,
)

Update an existing JointStateMap in-place from joint names and an ArmState, avoiding allocation when the map already contains the expected keys.