Added robot animation
Removed unused vars
Merge branch 'animation_feature' into develop