kinematics calculations update

made f4vdot function (+---).