Added Force Feedback
Fixed current control at the FPGA