Added variable arm length, extracted variables for parameters, fixed issues
Merge branch 'master' of https://github.com/Devilmore/GoalBabbling