socket.h

#pragma once
#include "avr/io.h"
#include "../can/can.h"
#include "../stream/stream.h"
#include <stdio.h>

class Socket : public Stream {

private:
    uint8_t id;

public:

    CAN *can;

#pragma clang diagnostic push
#pragma clang diagnostic ignored "-Wreturn-type"

    static Socket& GetInstance(uint8_t id = 0){
        if(id == 0){
            static Socket instance(0);
            return instance;
        }else if (id == 1){
            static Socket instance(1);
            return instance;
        }
    }
#pragma clang diagnostic pop

    static void HandleDataFromLowerLevel(CanMessage &message) {
        Socket &socket = Socket::GetInstance(message.id);
        socket.WriteToInputStream(message.data, message.size);
    }

    Socket(const Socket&) = delete;

    Socket(uint8_t id) : Stream(255, 1), id(id){
    }

    void Initialize(CAN *can){
        Socket::can = can;
        Socket::can->SetUpperLevel(&Socket::HandleDataFromLowerLevel);
    }

    void Write(uint8_t *string, uint16_t size);

    void WriteByte(uint8_t byte);
};