I believe I have the basics of the COM stuff working now for regular bodies and the hinge joint. I need to retrofit the other joints. This was a major pain in the ass. I needed to modify how the joint matrices were being created to take into account the COM offsets. Also, I needed to modify the reset simulation code to do the same. After I get the other joints converted over I need to go back through and get the static joint actually working again.