Вот решил сделать свою сборочку функций, которые я уже для себя накодил, думаю что они комунибудь да и пригодятся.
Вот сам файл.
В цикле приведена несложная работа с этими функциями, прокомментировал код, да и написал немного как реализовать коллизию и отталкивание этими функциями.
Жду вопросов!