Fixed and cleaned up the ERA IK code. Preparing to move on to SSRMS IK code.