Calculates x and y axes using the vision.

Currently written in C, but will be translated to C++. At this point, I'm not converting anything into a grid, so it's not super horrible I'm not using C++ just yet.

Also, I forgot to switch branches, my apologies.