Finished Controller and Camera class

Supports basic movement in 3d space