/** * Performs physics calculations based on the given angle values * * @param angles angles to be used for physics position calculation * @returns end-effector coordinate position */ public float[] Get_device_position(float[] angles) { mechanism.ForwardKinematics(angles); float[] endEffectorPosition = mechanism.Get_coordinate(); return(endEffectorPosition); }