Created Vector class

Created the vector class, which handles most of the mathematical aspects of motion and whatnot in the simulator.