Voodootikigod fix servo mapping

Fixing the servo as a special mode issue which seems to cause the disconnect between the Sofia Transport (which was the greatest from a distance discussion) and not working bots.