Added support for reversed servo directions