Added some vector functionality and curved collision, but it is faulty