More seriously, there are a lot of books on the subjects of game engines and physics. If you really want to "roll-your-own" I would suggest picking some up. Do a search on Amazon.
This is not an easy programming task, however. So if you are not an expert on C++, you should pick up some books on that first...
