Fix the value for simulation purpose
fix norm_transformation change header message in waypoint_gen