capsule collider support for RigidBodyController.cs, some tweaks and fix