box2d improvements/fixes

I beg pardon for putting several commits into a single pull request, I just not sure how to create separate pull requests yet..