fixed an error in turn routine so that it turns in shortest angle