Positions and velocities should be restricted, not tested yet
Merge branch 'master' of github.com:Plankton555/SOCS_project
Extracted Cohesion code to its own function