Added some maths helpers
Started to determine if overlapping