Update to core. Added console application and get methods for joint angles and torques