Added Service implementation for SoftBodyController
Refactoring SoftBodyController for divide compensation mode