Geom changes

More methods for Matrix33, also fixed rotations.
Renamed Vector2D set to setTo for verbosity.