modified gain and some codes to use l-arm to grasp object