Move lerp logic to rover_arm_system.hpp

[naterpotatoers]

Lerp should be handled in arm system and not in joint.hpp so that way we can more easily test our functions