Added object handling

IT ACTUALLY WORKS. I'M ACTUALLY PRETTY SHOCKED. But, this will be very
very useful. Added some extra maths and points to plug into a collision
detection function.