+#include <Servo.h>
 
 #include "SharpIR.h"
 #include "Communication.h"

    pinMode(IR_RIGHT, INPUT);
    pinMode(IR_FRONT_LEFT, INPUT);
    pinMode(IR_FRONT_RIGHT, INPUT);
}

void loop() {

uint8_t m_tx_len = 0;
HDLC hdlc(m_rx_buffer, 40);

Servo steeringservo;

void send_telemetry(uint8_t left, uint8_t right, uint8_t front_left, uint8_t front_right) {
    bc_telemetry_packet_t bc_telemetry;
    bc_telemetry.header = BC_TELEMETRY;
