fixed #1. Also the program can now be compiled withouth servo support by undefining