Update, environment return const shared pointers for getKinematicGroup and getJointGroup

[Levi-Armstrong]

Changes required now that the environment returns Const Shared Pointers for getKinematicGroup and getJointGroup

[codecov]

Codecov Report

All modified and coverable lines are covered by tests ✅

Project coverage is 77.83%. Comparing base (99f8b97) to head (4988945).
Report is 1 commits behind head on master.

Additional details and impacted files

@@           Coverage Diff           @@
##           master     #560   +/-   ##
=======================================
  Coverage   77.83%   77.83%           
=======================================
  Files         250      250           
  Lines       13100    13100           
=======================================
  Hits        10197    10197           
  Misses       2903     2903           

see 2 files with indirect coverage changes