/*
 *  AX.25 protocol frame structure:
 *  -------------------------------
 *
 *  Flag Field: 8 bits (1 byte)
 *  Header Field: 128 bits (16 bytes)
 *      {
 *    Destination Address: 56 bits (7 bytes)
 *    Source      Address: 56 bits (7 bytes)
 *    Control Bits       : 8  bits (1 byte )
 *    Protocol Identifier: 8  bits (1 byte )
 *  }
 *  Data Field: 32-2048 bits (4-256 bytes)
 *  Frame Checksum Field: 128 bits (16 bytes)
 *  Flag Field: 8 bits (1 byte)
 *
 */

#include<MD5.h>

unsigned char AX25_Flag;
unsigned char AX25_Header[16]  = {0};
unsigned char AX25_Data[256]   = {0};
unsigned char AX25_CheckSum[16] = {0};

int inByte = 0;
unsigned char* Hash;
char* MD5CheckSum;
int i;

void setup()
{
    // Serial1 : TX pin 18, RX pin 19
    // Serial2 : TX pin 16, RX pin 17
    // Serial1 will receive data from a device and resend it on Serial2 using AX25 protocol format

    Serial1.begin(9600);
    Serial2.begin(9600);
}

void loop()
{
    // Wait until data is received on Serial1 port
    while ( !(Serial1.available()) );

    // Read received data
    inByte = Serial1.read();
    Hash = MD5::make_hash(inByte);

    // Send the data using AX.25 protocol format
    AX25_Data[0] = (unsigned char) inByte & 0xFF;
    Hash = MD5::make_hash(AX25_Data[0]);
    MD5CheckSum = MD5::make_digest(Hash, 16);
    for ( i = 0; i < 16 ; i++)
        AX25_CheckSum[i] = MD5CheckSum[i];

    Serial2.write(AX25_Flag);
    Serial2.write(AX25_Header, 16);
    Serial2.write(AX25_Data, 256);
    Serial2.write(AX25_CheckSum, 16);
    Serial2.write(AX25_Flag);

    delay(500);
}