Added test case for servo timeout bug