Adding more math primitives

next steps should be to add collision and draw functions for debugging