Changed and added a few constants. Added and finished functions to move to ready position for second pierce and for actually piercing the second time. Wrote code to regrasp needle after second pierce and get the needle out.