+ if (SELFGUIDE.gt.0) then
+ distance=0.0
+ do j=1,3
+ vec_afm(j)=c(j,afmend)-c(j,afmbeg)
+ distance=distance+vec_afm(j)**2
+ enddo
+ distance=dsqrt(distance)
+ do j=1,3
+ d_t_work_new(j+(afmbeg-1)*3)=-velAFMconst*vec_afm(j)/distance
+ d_t_work_new(j+(afmend-1)*3)=velAFMconst*vec_afm(j)/distance
+ write(iout,*) "myvel",d_t_work_new(j+(afmbeg-1)*3),
+ & d_t_work_new(j+(afmend-1)*3)
+ enddo
+
+ endif
+