Fix servo angles