Cleanup b2dynamictree.
Use proper const annotations.