Changed width to match our robot experimentally
Stupid.
Got angle [hack] working.
Works?
Added deg2rad, broken now
Took out deg2rad, still wacky
Works better now.
Runs in square.
runs 4 corners