Add: Add APIs to access to offsets

Author: coord-e

src/include/servoarray/servoarray.h

@@ -49,6 +49,9 @@ class ServoArray {
   void set_read_mode(ReadMode);
   ReadMode read_mode() const;
 
+  double offset(std::size_t) const;
+  void set_offset(std::size_t, double);
+
   std::size_t size() const;
 };
 

src/lib/servoarray.cpp

@@ -69,6 +69,14 @@ ReadMode ServoArray::read_mode() const {
   return this->read_mode_;
 }
 
+double ServoArray::offset(std::size_t idx) const {
+  return this->offsets_[idx];
+}
+
+void ServoArray::set_offset(std::size_t idx, double value) {
+  this->offsets_[idx] = value;
+}
+
 std::size_t ServoArray::size() const {
   return this->driver_->size();
 }