#pragma once

#include <fsfw/devicehandlers/DeviceCommunicationIF.h>
#include <fsfw/objectmanager/SystemObject.h>

#include "SerialTCPCookie.h"

class ServoCommInterface : public DeviceCommunicationIF, public SystemObject {
 public:
  ServoCommInterface(object_id_t setObjectId);

  virtual ~ServoCommInterface() {}

  ReturnValue_t initializeInterface(CookieIF *cookie) override;

  ReturnValue_t sendMessage(CookieIF *cookie, const uint8_t *sendData, size_t sendLen) override;

  ReturnValue_t getSendSuccess(CookieIF *cookie) override;

  ReturnValue_t requestReceiveMessage(CookieIF *cookie, size_t requestLen) override;

  ReturnValue_t readReceivedMessage(CookieIF *cookie, uint8_t **buffer, size_t *size) override;

 private:
  ReturnValue_t initializeInterface(SerialTCPCookie *cookie);
  ReturnValue_t sendMessage(SerialTCPCookie *cookie, const uint8_t *sendData, size_t sendLen);
  ReturnValue_t readReceivedMessage(SerialTCPCookie *cookie, uint8_t **buffer, size_t *size);
};