Converted rigid body class to be more csharp-like