Modified to take in MSL input with 7 parameters instead of 3
Merge branch 'develop' of https://github.com/SZanlongo/robot-coordination-space into develop