code works with the steering servo and the esc somewhatdd

-ignore the counter int
-the huge snippet from line 78 to line 99 is for testing
-also lines 72-75 has multiplier that can be tweaked