Dynasti, I was right, for once :] I am just polishing the system at the moment. You see, the angle rotation does not support an arc higher than 1, as Arcsin(>1) can not be decided. Thus, I must add another constant so that if Arc > 1, C = Arc. And add some more stuff... You will see I am working on it.
Another thing, ATan or Atan2 is a hopeless case in a unit movement system, as it does make the pc freeze lag on some points.