Made servo code more precise.