Stage 1 Done: A unit that goes where you right click.
Created a math library for vector manipulation.