Fixed servo error reporting to work properly