Upgrade motion plans to accomodate head and tail movements.