Changed ramp_control to interrupt rotations for new trajectories
Uncommented portions of code that were commented out for testing