Troubleshooting given code for dual servo operation