Function G2(StartX, StartY, EndX, EndY, Radius)

I tried last night again, but, imagine this.

Distance between the two points is 5. Radius is 1. This just wouldn't work?