Adding math primitives

Adding primitives such as line segments, capsules