Finished Vector class, started fixing physics