calculate end effector forces/velocity, visualization