I/P : and O/P : where is the i-th joint velocity, v is the linear tool velocity vector and w is an angular tool velocity vector.