Fix inverse kin commmand and time t_vec
done with line, add two sphere saying the target points