Change CV control from the teensy side to the ROS2 side

[asun121]

For the CV control, instead of sending the buoy displacement, maintain the tracker servo angle on the ros2 side. This is because the teensy update significantly faster than ros2. This will cause the tracker angle on the teensy to keep accumulating

• Also the issue that we were dealing with on tuesday is because the sfr buffer size was wrong. I didnt push this fix, make sure when you guys start working to change the following:

In sfr.cpp line 23 : uint8_t buffer[2] = {0}; -> uint8_t buffer[3] = {0};

In sfr.hpp line 30 : extern uint8_t buffer[2]; -> extern uint8_t buffer[3];