Some small fixes added based on STEPFOC code that is a clone of this code.
- Added theta_offset calib.
- Fixed some issues related to gripper mode where it vibrates
NOTE added another entry to EEPROM memory. Loading this code to update your previous code you will need to run #Default to
load that new entry in EEPROM!