Adding more concise math/geometry utils based on vector math.

Test Plan:
WIP

Auditors: jack