Generation and Control of Basic Geometric Trajectories for a Robot Manipulator Using CompactRIO®

Algorithm 2

Algorithm for joint movement of MOVES.

      Data: Transformations Matrix ,

      Result: Interpolated positions

    ;

    ;

    ;

    ;

    ;

    ;

    ;

    for    do

       ;

    ;

    ;

    ;

    //;

    ;

    ;

     Inverse Kinematic Model

  end

  Interpolated positions ;