added: print coordinates in output simo, output level control in simo, fixed set_rigid_bodies simo
changed comment
added support for tests