Add ServoGroup class, update names.
Update code: lean behaviour now working
Update simulation routine files.