removed "1/4 filter"
fixed bugs in servo implementation
added SLEW rate
added MECH_OFFSET
changed mainloop to 100hz