A Novel Formation Creation Algorithm for Heterogeneous Vehicles in Highway Scenarios: Assessment and Experimental Validation