State machine updated, timer for grasps implemented, various changes..