Changed error logging to just print statements (doesn't necessarily run ros for kinematics)