improving the COG algorithm and reworking the bisector code with line intersection test and more vector math.
Added a script to plot out the output of the COG method given static conditions