hey @TomGeorge I ran your code I got these vales from the serial monitor
(I assume it wasn’t meant to make the robot move because there was no servo Write)
so I haven’t got the measurements for the pos it moved to
Hypotenuse 117.15 Angle A 50.19 Angle B 39.81
Your image really represents what I am trying to do But its is the next step that I am having a bit of trouble with
I am trying to find the green angels to write to the servos and am not to sure of the correct formula to do that where the
float numerator = (100 * 100 + C * C - 100 * 100);
came from witch is the Law of Cosines but looking back it was a bit dumb because as people have pointed out it just equals C
so I don’t think that pythagorizes is what the problem is but I could be missing something
But if you have a way to make the 2 reds and and blue line into 2 right angel triangles so it can find that angels. That’s seems to be the way I've been finding how most people do it but cant find any source code😒 ….
Regards.
but @xfpd Made a really good point I am going to spend the day trouble shooting with that for now

