можно было бы прикрутить Newton (это физический движок, в виде dll'ки)
а если так то может здесь что то поможет: http://www.maths.ru/7-6.html