Fixed thresholding of finite state controller
Clean commands to cuff + declare grips in Master

Only take grip readings larger than lastGrip for grabbing/ less than
lastGrip for releasing.
Working finite state with new smoothing