Beispiel #1
0
    /**
     * 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);
    }