changed position to Point3d. Debugged forces. Implemented WBoxEnv