FPGA controller for servos