Compare commits
3 Commits
| Author | SHA1 | Date | |
|---|---|---|---|
|
be407af3b7 | ||
| 8e55f440f4 | |||
|
|
0a2718c34f |
@ -13,3 +13,4 @@
|
|||||||
|
|
||||||
Деркачев Андрей
|
Деркачев Андрей
|
||||||
* Соединения и рефактор блоков UART, HDLC и вывода
|
* Соединения и рефактор блоков UART, HDLC и вывода
|
||||||
|
* Работа с I2C
|
||||||
125
client.c
125
client.c
@ -1,125 +0,0 @@
|
|||||||
#include "client.h"
|
|
||||||
|
|
||||||
#include <stdio.h>
|
|
||||||
#include <fcntl.h>
|
|
||||||
|
|
||||||
#define START_FLAG 0x7E
|
|
||||||
#define END_FLAG 0x7E
|
|
||||||
|
|
||||||
void init_Client(Client* client, bool test_is_valid, uint8_t address) {
|
|
||||||
client->TEST_IS_VALID = test_is_valid;
|
|
||||||
client->address = address;
|
|
||||||
client->_send_sequence_number = 0;
|
|
||||||
client->poll_final = 1;
|
|
||||||
client->_receive_sequence_number = 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
void connect(Client* client) {
|
|
||||||
UFrame u_frame;
|
|
||||||
init_UFrame(&u_frame, client->address, client->poll_final, "BP", NULL, 0);
|
|
||||||
|
|
||||||
uint8_t result[256];
|
|
||||||
create_frame(&u_frame.base, result);
|
|
||||||
|
|
||||||
|
|
||||||
// Wait for acknowledgment frame
|
|
||||||
bool flag = true;
|
|
||||||
uint8_t data;
|
|
||||||
while(flag){
|
|
||||||
data = uart_read();
|
|
||||||
if (data > 0){
|
|
||||||
flag = false;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
HDLCFrame frame;
|
|
||||||
init_HDLCFrame(&frame, 0, 0, &data + 3, 256 - 6);
|
|
||||||
if (validate(&data, 256)) {
|
|
||||||
return;
|
|
||||||
} else {
|
|
||||||
// Connection failed
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void send(Client* client, uint8_t* data, size_t data_length) {
|
|
||||||
connect(client);
|
|
||||||
|
|
||||||
IFrame i_frame;
|
|
||||||
init_IFrame(&i_frame, client->address, client->_receive_sequence_number, client->poll_final, client->_send_sequence_number, data, data_length);
|
|
||||||
|
|
||||||
uint8_t result[256];
|
|
||||||
create_frame(&i_frame.base, result);
|
|
||||||
|
|
||||||
uart_send_byte(*i_frame.base.data);
|
|
||||||
|
|
||||||
client->_send_sequence_number++;
|
|
||||||
}
|
|
||||||
|
|
||||||
void receive_data(uint8_t* recivedData) {
|
|
||||||
bool flag = true;
|
|
||||||
while(flag){
|
|
||||||
*recivedData = uart_read();
|
|
||||||
if (recivedData > 0){
|
|
||||||
flag = false;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
#include <stdbool.h>
|
|
||||||
|
|
||||||
bool validate(const uint8_t* frame, size_t length) {
|
|
||||||
if (length < 4 || frame[0] != START_FLAG || frame[length - 1] != END_FLAG) {
|
|
||||||
// Invalid frame length or missing start/end flag
|
|
||||||
return false;
|
|
||||||
}
|
|
||||||
|
|
||||||
uint16_t received_fcs = (frame[length - 3] << 8) | frame[length - 2];
|
|
||||||
uint16_t calculated_fcs = 0xFFFF;
|
|
||||||
|
|
||||||
for (size_t i = 1; i < length - 3; i++) {
|
|
||||||
uint8_t byte = frame[i];
|
|
||||||
calculated_fcs = (calculated_fcs >> 8) ^ (calculated_fcs << 8) ^ byte;
|
|
||||||
calculated_fcs &= 0xFFFF;
|
|
||||||
}
|
|
||||||
|
|
||||||
return received_fcs == calculated_fcs;
|
|
||||||
}
|
|
||||||
|
|
||||||
int sendSerialData(const char* port, uint8_t* data, size_t length) {
|
|
||||||
int serial_port = open(port, O_RDWR);
|
|
||||||
|
|
||||||
if (serial_port < 0) {
|
|
||||||
perror("Error opening the serial port");
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
|
|
||||||
ssize_t bytes_written = write(serial_port, data, length);
|
|
||||||
|
|
||||||
if (bytes_written < 0) {
|
|
||||||
perror("Error writing to the serial port");
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
|
|
||||||
close(serial_port);
|
|
||||||
return bytes_written;
|
|
||||||
}
|
|
||||||
|
|
||||||
int receiveSerialData(const char* port, uint8_t* data, int length) {
|
|
||||||
int serial_port = open(port, O_RDWR); // Replace "port" with your serial port device
|
|
||||||
|
|
||||||
if (serial_port < 0) {
|
|
||||||
perror("Error opening the serial port");
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
|
|
||||||
ssize_t bytes_read = read(serial_port, data, length);
|
|
||||||
|
|
||||||
if (bytes_read < 0) {
|
|
||||||
perror("Error reading from the serial port");
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
|
|
||||||
close(serial_port);
|
|
||||||
return bytes_read;
|
|
||||||
}
|
|
||||||
24
client.h
24
client.h
@ -1,24 +0,0 @@
|
|||||||
#ifndef CLIENT_H
|
|
||||||
#define CLIENT_H
|
|
||||||
|
|
||||||
#include "hdlc_frame.h"
|
|
||||||
#include "uart_module.h"
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include <stddef.h> // Для использования size_t
|
|
||||||
#include <stdint.h>
|
|
||||||
|
|
||||||
typedef struct {
|
|
||||||
bool TEST_IS_VALID;
|
|
||||||
uint8_t address;
|
|
||||||
uint8_t _send_sequence_number;
|
|
||||||
uint8_t poll_final;
|
|
||||||
uint8_t _receive_sequence_number;
|
|
||||||
} Client;
|
|
||||||
|
|
||||||
void init_Client(Client* client, bool test_is_valid, uint8_t address);
|
|
||||||
void connect(Client* client);
|
|
||||||
void send(Client* client, uint8_t* data, size_t data_length);
|
|
||||||
void receive_data(uint8_t* recivedData);
|
|
||||||
bool validate(const uint8_t* frame, size_t length);
|
|
||||||
|
|
||||||
#endif
|
|
||||||
380
frame.c
Normal file
380
frame.c
Normal file
@ -0,0 +1,380 @@
|
|||||||
|
#include "frame.h"
|
||||||
|
|
||||||
|
#include <stdio.h>
|
||||||
|
|
||||||
|
extern int window_length;
|
||||||
|
extern int raw_data_length;
|
||||||
|
extern int frame_number_range;
|
||||||
|
|
||||||
|
|
||||||
|
/* 33 crc*/
|
||||||
|
short crc[] = {1, 0, 0, 0, 0, 0,
|
||||||
|
1, 0, 0, 1, 1, 0,
|
||||||
|
0, 0, 0, 0, 1,
|
||||||
|
0, 0, 0, 1, 1, 1,
|
||||||
|
0, 1, 1, 0, 1, 1,
|
||||||
|
0, 1, 1, 1};
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
short send_receive_num[][3] = {{0, 0, 0},
|
||||||
|
{0, 0, 1},
|
||||||
|
{0, 1, 0},
|
||||||
|
{0, 1, 1},
|
||||||
|
{1, 0, 0},
|
||||||
|
{1, 0, 1},
|
||||||
|
{1, 1, 0},
|
||||||
|
{1, 1, 1}
|
||||||
|
};
|
||||||
|
|
||||||
|
static Frame *fill_flag_and_fcs(Frame *p_frame) {
|
||||||
|
|
||||||
|
short s[] = {0, 1, 1, 1, 1, 1, 1, 0};
|
||||||
|
int i;
|
||||||
|
for (i = 0; i < 8; ++i) {
|
||||||
|
p_frame ->head_flag[i] = s[i];
|
||||||
|
p_frame ->rail_flag[i] = s[i];
|
||||||
|
}
|
||||||
|
for (i = 0; i < (sizeof(crc) / sizeof(short) - 1); ++i) {
|
||||||
|
p_frame ->fcs[i] = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
return p_frame;
|
||||||
|
}
|
||||||
|
|
||||||
|
static Frame *create_generic_unnumbered_frame(Frame *p_frame) {
|
||||||
|
|
||||||
|
fill_flag_and_fcs(p_frame);
|
||||||
|
p_frame ->control[0] = 1;
|
||||||
|
p_frame ->control[1] = 1;
|
||||||
|
p_frame ->s.size = 0;
|
||||||
|
return p_frame;
|
||||||
|
}
|
||||||
|
|
||||||
|
static Frame *create_generic_info_frame(Frame *p_frame) {
|
||||||
|
|
||||||
|
fill_flag_and_fcs(p_frame);
|
||||||
|
p_frame ->control[0] = 0;
|
||||||
|
p_frame ->s.size = 0;
|
||||||
|
return p_frame;
|
||||||
|
}
|
||||||
|
|
||||||
|
static Frame *create_generic_sup_frame(Frame *p_frame) {
|
||||||
|
|
||||||
|
fill_flag_and_fcs(p_frame);
|
||||||
|
p_frame ->control[0] = 1;
|
||||||
|
p_frame ->control[1] = 0;
|
||||||
|
p_frame ->s.size = 0;
|
||||||
|
return p_frame;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static void convert_frame_to_seq(Frame *p_frame, short seq[], int *size) {
|
||||||
|
|
||||||
|
int i;
|
||||||
|
(*size) = 0;
|
||||||
|
for (i = 0; i < 8; ++i) {
|
||||||
|
seq[*size] = p_frame ->address[i];
|
||||||
|
++(*size);
|
||||||
|
}
|
||||||
|
|
||||||
|
for (i = 0; i < 8; ++i) {
|
||||||
|
seq[*size] = p_frame ->control[i];
|
||||||
|
++(*size);
|
||||||
|
}
|
||||||
|
|
||||||
|
for (i = 0; i < p_frame ->s.size; ++i) {
|
||||||
|
if (1 == (p_frame ->s.infor_type[i])) {
|
||||||
|
seq[*size] = p_frame ->s.information[i];
|
||||||
|
++(*size);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
for (i = 0; i < sizeof(crc) / sizeof(short) - 1; ++i) {
|
||||||
|
seq[*size] = p_frame ->fcs[i];
|
||||||
|
++(*size);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/* 0 has been filled before calling this method.*/
|
||||||
|
|
||||||
|
static int seq_fcs(short seq[], int size) {
|
||||||
|
|
||||||
|
int i;
|
||||||
|
int non_zero = 0;
|
||||||
|
int temp_non_zero;
|
||||||
|
bool new_non_zero = 0;
|
||||||
|
|
||||||
|
for (i = 0; i < size; ++i) {
|
||||||
|
if (1 == seq[i]) {
|
||||||
|
non_zero = i;
|
||||||
|
new_non_zero = 1;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
for (;non_zero <= size - sizeof(crc)/sizeof(short);) {
|
||||||
|
new_non_zero = 0;
|
||||||
|
temp_non_zero = -1;
|
||||||
|
for (i = non_zero; i < non_zero + sizeof(crc)/sizeof(short); ++i) {
|
||||||
|
seq[i] ^= crc[i - non_zero];
|
||||||
|
if ((1 == seq[i]) && !new_non_zero) {
|
||||||
|
temp_non_zero = i;
|
||||||
|
new_non_zero = 1;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (-1 == temp_non_zero) {
|
||||||
|
for (i = non_zero + sizeof(crc) / sizeof(short); i < size; ++i) {
|
||||||
|
if (1 == seq[i]) {
|
||||||
|
non_zero = i;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
if (i == size) return -1;
|
||||||
|
} else {
|
||||||
|
non_zero = temp_non_zero;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return non_zero;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*Here add fcs to one frame*/
|
||||||
|
static void add_fcs_to_frame(Frame *p_frame) {
|
||||||
|
|
||||||
|
short seq[1024];
|
||||||
|
int size = 0;
|
||||||
|
int i;
|
||||||
|
int non_zero = 0;
|
||||||
|
|
||||||
|
convert_frame_to_seq(p_frame, seq, &size);
|
||||||
|
|
||||||
|
seq_fcs(seq, size);
|
||||||
|
|
||||||
|
for (i = 0; i < sizeof(crc)/sizeof(short) - 1; ++i) {
|
||||||
|
p_frame ->fcs[i] = seq[size - (sizeof(crc)/sizeof(short) - 1) + i];
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static void convert_decimal_2_binary(int decimal, short binary[]) {
|
||||||
|
|
||||||
|
binary[2] = decimal % 2;
|
||||||
|
binary[0] = decimal / 4;
|
||||||
|
binary[1] = (decimal - binary[0] * 4) / 2;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*Here create SABME, UA and DISC.*/
|
||||||
|
Frame create_unnumbered_frame(short addr[], enum FRAME_TYPE ft, bool p_f) {
|
||||||
|
|
||||||
|
Frame f;
|
||||||
|
short s1[] = {1, 1, 0, 1, 1, 0};/* For SABME*/
|
||||||
|
short s2[] = {0, 0, 0, 1, 1, 0};/* For UA*/
|
||||||
|
short s3[] = {0, 0, 0, 0, 1, 0};/* For DISC*/
|
||||||
|
int i;
|
||||||
|
|
||||||
|
create_generic_unnumbered_frame(&f);
|
||||||
|
|
||||||
|
for (i = 0; i < 8; ++i) {
|
||||||
|
f.address[i] = addr[i];
|
||||||
|
}
|
||||||
|
|
||||||
|
switch(ft) {
|
||||||
|
case SABME :
|
||||||
|
for (i = 2; i < 8; ++i) {
|
||||||
|
f.control[i] = s1[i - 2];
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
case UA :
|
||||||
|
for (i = 2; i < 8; ++i) {
|
||||||
|
f.control[i] = s2[i - 2];
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
case DISC :
|
||||||
|
for (i = 2; i < 8; ++i) {
|
||||||
|
f.control[i] = s3[i - 2];
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
default : fprintf(stderr, "Call create unnumbered frame error!\n");
|
||||||
|
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
f.control[4] = p_f;
|
||||||
|
|
||||||
|
add_fcs_to_frame(&f);
|
||||||
|
return f;
|
||||||
|
}
|
||||||
|
|
||||||
|
Frame create_sup_frame(short addr[], enum FRAME_TYPE ft, bool p_f, short want_receive) {
|
||||||
|
Frame f;
|
||||||
|
int i;
|
||||||
|
short next_receive[3];
|
||||||
|
create_generic_sup_frame(&f);
|
||||||
|
|
||||||
|
for (i = 0; i < 8; ++i) {
|
||||||
|
f.address[i] = addr[i];
|
||||||
|
}
|
||||||
|
|
||||||
|
f.control[2] = 0;
|
||||||
|
switch(ft) {
|
||||||
|
case RR :
|
||||||
|
f.control[3] = 0;
|
||||||
|
break;
|
||||||
|
case REJ :
|
||||||
|
f.control[3] = 1;
|
||||||
|
break;
|
||||||
|
default :
|
||||||
|
fprintf(stderr, "create sup frame error!\n");
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
f.control[4] = p_f;
|
||||||
|
|
||||||
|
|
||||||
|
convert_decimal_2_binary(want_receive, next_receive);
|
||||||
|
for (i = 5; i < 8; ++i) {
|
||||||
|
f.control[i] = next_receive[i - 5];
|
||||||
|
}
|
||||||
|
|
||||||
|
add_fcs_to_frame(&f);
|
||||||
|
return f;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
/* prequestic : ($end - $start) % $raw_data_length = 0*/
|
||||||
|
Frame* create_infor_frames(short addr[], short send_n, bool p_f, short receive_n,
|
||||||
|
short data[], int start, int end, Frame *frames) { /*Normal data transferring.*/
|
||||||
|
|
||||||
|
Frame f;
|
||||||
|
int i;
|
||||||
|
int j;
|
||||||
|
int k;
|
||||||
|
int ite = 0;
|
||||||
|
short receive_number[3];
|
||||||
|
short send_number[3];
|
||||||
|
|
||||||
|
if ((end -start + 1) > (850 * window_length)) {
|
||||||
|
fprintf(stderr, "One frame takes too long data!\n");
|
||||||
|
return &f;
|
||||||
|
}
|
||||||
|
|
||||||
|
convert_decimal_2_binary(receive_n, receive_number);
|
||||||
|
|
||||||
|
for (ite = 0; ite < ((end - start) / raw_data_length); ++ite) {
|
||||||
|
|
||||||
|
create_generic_info_frame(&f);
|
||||||
|
convert_decimal_2_binary(send_n, send_number);
|
||||||
|
for (i = 1; i < 4; ++i) {
|
||||||
|
|
||||||
|
f.control[i] = send_number[i - 1];
|
||||||
|
f.control[i + 4] = receive_number[i - 1];
|
||||||
|
}
|
||||||
|
|
||||||
|
send_n = (send_n + 1) % frame_number_range;
|
||||||
|
f.control[4] = p_f;
|
||||||
|
|
||||||
|
j = 0;
|
||||||
|
k = 0;
|
||||||
|
|
||||||
|
|
||||||
|
/*bit stuffing!*/
|
||||||
|
for (i = start + ite * raw_data_length; i < start + (ite + 1) * raw_data_length; ++i) {
|
||||||
|
|
||||||
|
f.s.information[k] = data[i]; f.s.infor_type[k] = 1; ++k; ++f.s.size;
|
||||||
|
if (1 == data[i]) {
|
||||||
|
if (4 == (i - j)) {
|
||||||
|
f.s.information[k] = 0; f.s.infor_type[k] = 0; ++k; ++f.s.size;
|
||||||
|
j = i + 1;
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
j = i + 1;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
add_fcs_to_frame(&f);
|
||||||
|
frames[ite] = f;
|
||||||
|
}
|
||||||
|
return frames;
|
||||||
|
}
|
||||||
|
|
||||||
|
short unnumbered[][8] = {
|
||||||
|
{1, 1, 1, 1, 0, 1, 1, 0}, /*SABME*/
|
||||||
|
{1, 1, 0, 0, 0, 1, 1, 0}, /*UA*/
|
||||||
|
{1, 1, 0, 0, 0, 0, 1, 0} /*DISC*/ };
|
||||||
|
|
||||||
|
enum FRAME_TYPE get_frame_type(Frame *p_frame) {
|
||||||
|
|
||||||
|
if (0 == p_frame ->control[0]) {
|
||||||
|
return INFOR;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (0 == p_frame ->control[1]) {
|
||||||
|
if (0 == p_frame ->control[3]) return RR;
|
||||||
|
else return REJ;
|
||||||
|
} else {
|
||||||
|
if (1 == p_frame ->control[2]) return SABME;
|
||||||
|
else {
|
||||||
|
if (1 == p_frame ->control[5]) return UA;
|
||||||
|
else return DISC;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
fprintf(stdout, "Inteprete Frame type error!\n");
|
||||||
|
return INFOR;
|
||||||
|
}
|
||||||
|
|
||||||
|
void get_address(Frame *p_frame, short *storage) {
|
||||||
|
|
||||||
|
int i;
|
||||||
|
for (i = 0; i < 8; ++i) {
|
||||||
|
storage[i] = p_frame ->address[i];
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Only for INFOR, */
|
||||||
|
short get_send_number(Frame *p_frame) {
|
||||||
|
|
||||||
|
int num;
|
||||||
|
num = p_frame ->control[1] * 4 + p_frame ->control[2] * 2 + p_frame ->control[3];
|
||||||
|
return num;
|
||||||
|
}
|
||||||
|
/* For INFOR, RR, REJ.*/
|
||||||
|
short get_expect_number(Frame *p_frame) {
|
||||||
|
|
||||||
|
int num;
|
||||||
|
num = p_frame ->control[5] * 4 + p_frame ->control[6] * 2 + p_frame ->control[7];
|
||||||
|
return num;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Only for INFOR.*/
|
||||||
|
void get_infor(Frame *p_frame, short *storage, int *size) {
|
||||||
|
int i;
|
||||||
|
*size = 0;
|
||||||
|
|
||||||
|
for (i = 0; i < p_frame ->s.size; ++i) {
|
||||||
|
if (1 == p_frame ->s.infor_type[i]) {
|
||||||
|
storage[*size] = p_frame ->s.information[i];
|
||||||
|
++(*size);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/*Here using fcs to judge whether the data is right.*/
|
||||||
|
bool is_fcs_right(Frame *p_frame) {
|
||||||
|
|
||||||
|
short seq[1024];
|
||||||
|
int size = 0;
|
||||||
|
int non_zero;
|
||||||
|
int i;
|
||||||
|
|
||||||
|
convert_frame_to_seq(p_frame, seq, &size);
|
||||||
|
|
||||||
|
non_zero = seq_fcs(seq, size);
|
||||||
|
if (-1 == non_zero) {
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
57
frame.h
Normal file
57
frame.h
Normal file
@ -0,0 +1,57 @@
|
|||||||
|
#ifndef _FRAME_H
|
||||||
|
#define _FRAME_H
|
||||||
|
|
||||||
|
typedef int bool;
|
||||||
|
|
||||||
|
/*This is the frame structure in HDLC.*/
|
||||||
|
typedef struct Frame {
|
||||||
|
|
||||||
|
short head_flag[8];
|
||||||
|
short address[8];
|
||||||
|
short control[8];
|
||||||
|
struct{
|
||||||
|
|
||||||
|
/*Actuall size should also be arry. It is also sequence of '01', here I simplify it.*/
|
||||||
|
short size; /*Record the real length of the data.*/
|
||||||
|
short information[1024];/*Capacity is 1024.*/
|
||||||
|
short infor_type[1024]; /*0 : bit stuffing; 1 : real data.*/
|
||||||
|
}s;
|
||||||
|
|
||||||
|
short fcs[32];
|
||||||
|
short rail_flag[8];
|
||||||
|
}Frame;
|
||||||
|
|
||||||
|
enum FRAME_TYPE {SABME, DISC, UA, REJ, RR, INFOR};
|
||||||
|
|
||||||
|
/* SABME, UA and DISC*/
|
||||||
|
Frame create_unnumbered_frame(short addr[], enum FRAME_TYPE ft, bool p_f);
|
||||||
|
|
||||||
|
/* REJ, RR*/
|
||||||
|
Frame create_sup_frame(short addr[], enum FRAME_TYPE ft, bool p_f, short next_receive);
|
||||||
|
|
||||||
|
/* Frame for normal data transferring.*/
|
||||||
|
Frame* create_infor_frames(short addr[], short send_number, bool p_f,
|
||||||
|
short receive_number, short data[], int start, int end, Frame *frames);/* Using $start,$end, better than $size*/
|
||||||
|
|
||||||
|
/*Extract frame type from the given frame. */
|
||||||
|
enum FRAME_TYPE get_frame_type(Frame *p_frame);
|
||||||
|
|
||||||
|
|
||||||
|
/* Extract address field from the given frame.*/
|
||||||
|
void get_address(Frame *p_frame, short *storage);
|
||||||
|
|
||||||
|
/* The # of the frame.*/
|
||||||
|
short get_send_number(Frame *p_frame);
|
||||||
|
|
||||||
|
/* The # of the frame sender wants.*/
|
||||||
|
short get_expect_number(Frame *p_frame);
|
||||||
|
|
||||||
|
/* Extract the real data from the given frame.*/
|
||||||
|
void get_infor(Frame *p_frame, short *storage, int *size);
|
||||||
|
|
||||||
|
|
||||||
|
/*Here using fcs to judge whether the data is right.*/
|
||||||
|
bool is_fcs_right(Frame *p_frame);
|
||||||
|
|
||||||
|
|
||||||
|
#endif
|
||||||
108
hdlc_frame.c
108
hdlc_frame.c
@ -1,108 +0,0 @@
|
|||||||
#include "hdlc_frame.h"
|
|
||||||
|
|
||||||
#include <string.h>
|
|
||||||
|
|
||||||
#define START_FLAG 0x7E
|
|
||||||
#define END_FLAG 0x7E
|
|
||||||
#define ESCAPE_FLAG 0x7D
|
|
||||||
#define ESCAPE_XOR 0x20
|
|
||||||
|
|
||||||
void init_HDLCFrame(HDLCFrame* frame, uint8_t address, uint8_t control, uint8_t* data, size_t data_length) {
|
|
||||||
frame->address = address;
|
|
||||||
frame->control = control;
|
|
||||||
frame->data = data;
|
|
||||||
frame->data_length = data_length;
|
|
||||||
}
|
|
||||||
|
|
||||||
uint16_t calculate_fcs(const HDLCFrame *frame, size_t i) {
|
|
||||||
uint16_t fcs = 0xFFFF;
|
|
||||||
|
|
||||||
uint8_t data_bytes[2 + frame->data_length];
|
|
||||||
data_bytes[0] = frame->address;
|
|
||||||
data_bytes[1] = frame->control;
|
|
||||||
memcpy(data_bytes + 2, frame->data, frame->data_length);
|
|
||||||
|
|
||||||
for (size_t i = 0; i < frame->data_length + 2; i++) {
|
|
||||||
uint8_t byte = data_bytes[i];
|
|
||||||
fcs = (fcs >> 8) ^ (fcs << 8) ^ byte;
|
|
||||||
fcs &= 0xFFFF;
|
|
||||||
}
|
|
||||||
|
|
||||||
return fcs;
|
|
||||||
}
|
|
||||||
|
|
||||||
void create_frame(const HDLCFrame* frame, uint8_t* result) {
|
|
||||||
size_t index = 0;
|
|
||||||
|
|
||||||
result[index++] = START_FLAG;
|
|
||||||
result[index++] = frame->address;
|
|
||||||
result[index++] = frame->control;
|
|
||||||
|
|
||||||
if (frame->data != NULL) {
|
|
||||||
for (size_t i = 0; i < frame->data_length; i++) {
|
|
||||||
uint8_t byte = frame->data[i];
|
|
||||||
if (byte == START_FLAG || byte == END_FLAG || byte == ESCAPE_FLAG) {
|
|
||||||
result[index++] = ESCAPE_FLAG;
|
|
||||||
result[index++] = byte ^ ESCAPE_XOR;
|
|
||||||
} else {
|
|
||||||
result[index++] = byte;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
uint16_t fcs = calculate_fcs(frame, 0);
|
|
||||||
result[index++] = fcs & 0xFF;
|
|
||||||
result[index++] = (fcs >> 8) & 0xFF;
|
|
||||||
result[index++] = END_FLAG;
|
|
||||||
}
|
|
||||||
|
|
||||||
void init_IFrame(IFrame* frame, uint8_t address, uint8_t receive_sequence_number, uint8_t poll_final,
|
|
||||||
uint8_t send_sequence_number, uint8_t* data, size_t data_length) {
|
|
||||||
init_HDLCFrame(&frame->base, address,
|
|
||||||
((receive_sequence_number & 0b111) << 6) | ((poll_final & 0b1) << 4) |
|
|
||||||
((send_sequence_number & 0b111) << 1) | 0,
|
|
||||||
data, data_length);
|
|
||||||
frame->receive_sequence_number = receive_sequence_number;
|
|
||||||
frame->poll_final = poll_final;
|
|
||||||
frame->send_sequence_number = send_sequence_number;
|
|
||||||
}
|
|
||||||
|
|
||||||
void init_SFrame(SFrame* frame, uint8_t address, uint8_t receive_sequence_number, uint8_t poll_final,
|
|
||||||
const char* frame_type) {
|
|
||||||
uint8_t frame_type_value;
|
|
||||||
if (strcmp(frame_type, "RR") == 0) {
|
|
||||||
frame_type_value = 0;
|
|
||||||
} else if (strcmp(frame_type, "RNR") == 0) {
|
|
||||||
frame_type_value = 1;
|
|
||||||
} else if (strcmp(frame_type, "REJ") == 0) {
|
|
||||||
frame_type_value = 2;
|
|
||||||
} else if (strcmp(frame_type, "SREJ") == 0) {
|
|
||||||
frame_type_value = 3;
|
|
||||||
} else {
|
|
||||||
// Handle error
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
init_HDLCFrame(&frame->base, address,
|
|
||||||
((receive_sequence_number & 0b111) << 6) | ((poll_final & 0b1) << 5) |
|
|
||||||
((frame_type_value & 0b111) << 2) | 1,
|
|
||||||
NULL, 0);
|
|
||||||
frame->receive_sequence_number = receive_sequence_number;
|
|
||||||
frame->poll_final = poll_final;
|
|
||||||
frame->frame_type = frame_type;
|
|
||||||
}
|
|
||||||
|
|
||||||
void init_UFrame(UFrame* frame, uint8_t address, uint8_t poll_final, const char* frame_type,
|
|
||||||
uint8_t* data, size_t data_length) {
|
|
||||||
uint8_t frame_type_value;
|
|
||||||
if (strcmp(frame_type, "BP") == 0) {
|
|
||||||
frame_type_value = 63;
|
|
||||||
} else {
|
|
||||||
// Handle error
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
init_HDLCFrame(&frame->base, address, (frame_type_value << 2) | 3, data, data_length);
|
|
||||||
frame->poll_final = poll_final;
|
|
||||||
frame->frame_type = frame_type;
|
|
||||||
}
|
|
||||||
45
hdlc_frame.h
45
hdlc_frame.h
@ -1,45 +0,0 @@
|
|||||||
#ifndef HDLC_FRAME_H
|
|
||||||
#define HDLC_FRAME_H
|
|
||||||
|
|
||||||
#include <stdint.h>
|
|
||||||
|
|
||||||
typedef struct {
|
|
||||||
uint8_t address;
|
|
||||||
uint8_t control;
|
|
||||||
uint8_t* data;
|
|
||||||
size_t data_length;
|
|
||||||
} HDLCFrame;
|
|
||||||
|
|
||||||
void init_HDLCFrame(HDLCFrame* frame, uint8_t address, uint8_t control, uint8_t* data, size_t data_length);
|
|
||||||
uint16_t calculate_fcs(const HDLCFrame *frame, size_t i);
|
|
||||||
void create_frame(const HDLCFrame* frame, uint8_t* result);
|
|
||||||
|
|
||||||
typedef struct {
|
|
||||||
HDLCFrame base;
|
|
||||||
uint8_t receive_sequence_number;
|
|
||||||
uint8_t poll_final;
|
|
||||||
uint8_t send_sequence_number;
|
|
||||||
} IFrame;
|
|
||||||
|
|
||||||
void init_IFrame(IFrame* frame, uint8_t address, uint8_t receive_sequence_number, uint8_t poll_final,
|
|
||||||
uint8_t send_sequence_number, uint8_t* data, size_t data_length);
|
|
||||||
|
|
||||||
typedef struct {
|
|
||||||
HDLCFrame base;
|
|
||||||
uint8_t receive_sequence_number;
|
|
||||||
uint8_t poll_final;
|
|
||||||
const char* frame_type;
|
|
||||||
} SFrame;
|
|
||||||
|
|
||||||
void init_SFrame(SFrame* frame, uint8_t address, uint8_t receive_sequence_number, uint8_t poll_final,
|
|
||||||
const char* frame_type);
|
|
||||||
|
|
||||||
typedef struct {
|
|
||||||
HDLCFrame base;
|
|
||||||
uint8_t poll_final;
|
|
||||||
const char* frame_type;
|
|
||||||
} UFrame;
|
|
||||||
|
|
||||||
void init_UFrame(UFrame* frame, uint8_t address, uint8_t poll_final, const char* frame_type, uint8_t* data, size_t data_length);
|
|
||||||
|
|
||||||
#endif
|
|
||||||
25
main.c
25
main.c
@ -1,25 +0,0 @@
|
|||||||
#include <stdint.h>
|
|
||||||
#include "config.h"
|
|
||||||
#include <avr/io.h>
|
|
||||||
#include <util/delay.h>
|
|
||||||
#include <avr/interrupt.h>
|
|
||||||
#include "uart_hal.h"
|
|
||||||
|
|
||||||
|
|
||||||
int main(void)
|
|
||||||
{
|
|
||||||
//example
|
|
||||||
uint8_t data = 'A';
|
|
||||||
|
|
||||||
uart_init(9600,0);
|
|
||||||
uart_send_byte(data);
|
|
||||||
sei();
|
|
||||||
while (1)
|
|
||||||
{
|
|
||||||
if(uart_read_count() > 0){
|
|
||||||
data = uart_read();
|
|
||||||
uart_send_byte(data);
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
}
|
|
||||||
@ -1,82 +0,0 @@
|
|||||||
#include "uart_hal.h"
|
|
||||||
|
|
||||||
volatile static uint8_t rx_buffer[RX_BUFFER_SIZE] = {0};
|
|
||||||
volatile static uint16_t rx_count = 0;
|
|
||||||
volatile static uint8_t uart_tx_busy = 1;
|
|
||||||
// кольцевой буффер
|
|
||||||
ISR(USART_RX_vect){
|
|
||||||
|
|
||||||
volatile static uint16_t rx_write_pos = 0;
|
|
||||||
|
|
||||||
rx_buffer[rx_write_pos] = UDR0;
|
|
||||||
rx_count++;
|
|
||||||
rx_write_pos++;
|
|
||||||
if(rx_write_pos >= RX_BUFFER_SIZE){
|
|
||||||
rx_write_pos = 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
ISR(USART_TX_vect){
|
|
||||||
uart_tx_busy = 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
void uart_init(uint32_t baud,uint8_t high_speed){
|
|
||||||
|
|
||||||
uint8_t speed = 16;
|
|
||||||
|
|
||||||
if(high_speed != 0){
|
|
||||||
speed = 8;
|
|
||||||
UCSR0A |= 1 << U2X0;
|
|
||||||
}
|
|
||||||
|
|
||||||
baud = (F_CPU/(speed*baud)) - 1;
|
|
||||||
|
|
||||||
UBRR0H = (baud & 0x0F00) >> 8;
|
|
||||||
UBRR0L = (baud & 0x00FF);
|
|
||||||
|
|
||||||
UCSR0B |= (1 << TXEN0) | (1 << RXEN0) | (1 << TXCIE0) | (1 << RXCIE0);
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
void uart_send_byte(uint8_t c){
|
|
||||||
while(uart_tx_busy == 0);
|
|
||||||
uart_tx_busy = 0;
|
|
||||||
UDR0 = c;
|
|
||||||
}
|
|
||||||
|
|
||||||
void uart_send_array(uint8_t *c,uint16_t len){
|
|
||||||
for(uint16_t i = 0; i < len;i++){
|
|
||||||
uart_send_byte(c[i]);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void uart_send_string(uint8_t *c){
|
|
||||||
uint16_t i = 0;
|
|
||||||
do{
|
|
||||||
uart_send_byte(c[i]);
|
|
||||||
i++;
|
|
||||||
|
|
||||||
}while(c[i] != '\0');
|
|
||||||
uart_send_byte(c[i]);
|
|
||||||
}
|
|
||||||
|
|
||||||
uint16_t uart_read_count(void){
|
|
||||||
return rx_count;
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t uart_read(void){
|
|
||||||
static uint16_t rx_read_pos = 0;
|
|
||||||
uint8_t data = 0;
|
|
||||||
|
|
||||||
data = rx_buffer[rx_read_pos];
|
|
||||||
rx_read_pos++;
|
|
||||||
rx_count--;
|
|
||||||
if(rx_read_pos >= RX_BUFFER_SIZE){
|
|
||||||
rx_read_pos = 0;
|
|
||||||
}
|
|
||||||
return data;
|
|
||||||
}
|
|
||||||
@ -1,20 +0,0 @@
|
|||||||
#ifndef UART_HAL_H_
|
|
||||||
#define UART_HAL_H_
|
|
||||||
|
|
||||||
|
|
||||||
#include <stdint.h>
|
|
||||||
#include "config.h"
|
|
||||||
#include <avr/io.h>
|
|
||||||
#include <util/delay.h>
|
|
||||||
#include <avr/interrupt.h>
|
|
||||||
|
|
||||||
#define RX_BUFFER_SIZE 128
|
|
||||||
|
|
||||||
void uart_init(uint32_t baud,uint8_t high_speed);
|
|
||||||
void uart_send_byte(uint8_t c);
|
|
||||||
void uart_send_array(uint8_t *c,uint16_t len);
|
|
||||||
void uart_send_string(uint8_t *c);
|
|
||||||
uint16_t uart_read_count(void);
|
|
||||||
uint8_t uart_read(void);
|
|
||||||
|
|
||||||
#endif /* UART_HAL_H_ */
|
|
||||||
Loading…
Reference in New Issue
Block a user