Added a benchmarking script and optimized the Vector2d library for speed