It looks ok. IIUC, your initial position is (5569,6269) and the desired target is (6335,5626). This gives (dx,dy)=(766,-643) and a distance of 1000.1 > 1000.
Thus, the position is increased by (766,-643)*1000/1000.1 which gives (6334,5626) when floored.