Updated rigid bodies, XMLReader (still not compile ready)