Made project into frc iterative project
Added some helper classes like Vector, Point etc