Готово Контрольная сумма

This commit is contained in:
Павел Вершинин 2023-05-11 17:25:39 +03:00
parent 6b39c55d91
commit 294a5b9ac8
6 changed files with 75 additions and 35 deletions

View File

@ -17,16 +17,17 @@ void setup()
void loop() void loop()
{ {
char data[] = {6, 1, 3, 5, 16, 17, 18, 0}; char data[] = {0x06, 0xF1, 0x04, 0x05, 0x16, 0x12, 0x18, 0x11, 0x00, 0x15, 0x49, 0x50, 0x59, 0x69, 0};
int length = sizeof(data); int length = sizeof(data);
Serial.println();
Serial.print("Start: "); Serial.print("Start: ");
Print(data, length); Print(data, length);
Serial.println(); Serial.println();
char checking = CRC8(data, length-1); char checking = crc8(data, length-1);
int size = sizeof(data) / sizeof(data[0]); int size = sizeof(data) / sizeof(data[0]);
data[size - 1] = checking; data[size - 1] = checking;
Serial.println(checking, HEX);
Serial.print("End: "); Serial.print("End: ");
Print(data, length); Print(data, length);

View File

@ -7,15 +7,14 @@ void SPI_MasterInit(void)
{ {
DDR_SPI = (1 << DD_MOSI) | (1 << DD_SCK) | (1 << DD_SS); DDR_SPI = (1 << DD_MOSI) | (1 << DD_SCK) | (1 << DD_SS);
DDRB |= (1<<DDB2); DDRB |= (1<<DDB2);
SPCR = (1 << SPE) | (1 << MSTR); SPCR = (1 << SPE) | (1 << MSTR) | (1 << SPR1);
// SPCR = (1 << SPE) | (1 << MSTR) ;
} }
void SPI_MasterTransmit(char *data, int length) void SPI_MasterTransmit(char *data, int length)
{ {
PORTB &= ~(1<<2); PORTB &= ~(1<<2);
int size = sizeof(data) / sizeof(data[0]);
for(int i = 0; i < length; i++) { for(int i = 0; i < length; i++) {
SPDR = data[i]; // отправляем байт массива SPDR = data[i]; // отправляем байт массива
while (!(SPSR & (1 << SPIF))); // ждем, пока байт передастся while (!(SPSR & (1 << SPIF))); // ждем, пока байт передастся
@ -28,7 +27,7 @@ char CRC8(char *data, int length) {
char crc = 0x00; char crc = 0x00;
char poly = 0x07; // полином для CRC8 char poly = 0x07; // полином для CRC8
for (int i = 0; i < length-2; i++) { for (int i = 0; i < length; i++) {
crc ^= data[i]; // XOR текущего байта с crc crc ^= data[i]; // XOR текущего байта с crc
for (int j = 0; j < length; j++) { for (int j = 0; j < length; j++) {
@ -43,3 +42,17 @@ char CRC8(char *data, int length) {
return crc; return crc;
} }
char crc8(char *data, int len) {
char crc = 0x00;
while (len--) {
crc ^= *data++;
for (int i = 0; i < 8; i++) {
if (crc & 0x80) {
crc = (crc << 1) ^ 0x07;
} else {
crc <<= 1;
}
}
}
return crc;
}

View File

@ -14,6 +14,7 @@ extern "C" {
void SPI_MasterInit(void); void SPI_MasterInit(void);
void SPI_MasterTransmit(char *data, int length); void SPI_MasterTransmit(char *data, int length);
char CRC8(char *data, int length); char CRC8(char *data, int length);
char crc8(char *data, int len);
#ifdef __cplusplus #ifdef __cplusplus
} }

View File

@ -16,7 +16,7 @@ char CRC8(char *data, int length) {
char crc = 0x00; char crc = 0x00;
char poly = 0x07; // полином для CRC8 char poly = 0x07; // полином для CRC8
for (int i = 0; i < length-2; i++) { for (int i = 0; i < length; i++) {
crc ^= data[i]; // XOR текущего байта с crc crc ^= data[i]; // XOR текущего байта с crc
for (int j = 0; j < length; j++) { for (int j = 0; j < length; j++) {
@ -31,6 +31,22 @@ char CRC8(char *data, int length) {
return crc; return crc;
} }
char crc8(char *data, int len) {
char crc = 0x00;
while (len--) {
crc ^= *data++;
for (int i = 0; i < 8; i++) {
if (crc & 0x80) {
crc = (crc << 1) ^ 0x07;
} else {
crc <<= 1;
}
}
}
return crc;
}
// Проверка массива на ноль // Проверка массива на ноль
char checkArray(char *arr, int size) { char checkArray(char *arr, int size) {
for (int i = 0; i < size; i++) { for (int i = 0; i < size; i++) {

View File

@ -16,6 +16,8 @@ void SPI_SlaveInit(void);
char CRC8(char *data, int length); char CRC8(char *data, int length);
char checkArray(char *arr, int size); char checkArray(char *arr, int size);
char crc8(char *data, int len);
#ifdef __cplusplus #ifdef __cplusplus
} }
#endif #endif

View File

@ -12,7 +12,7 @@
static int index = 0; static int index = 0;
static int arIndex = 0; static int arIndex = 0;
static char data[255]; static char data[64];
// void SPI_SlaveInit(void) // void SPI_SlaveInit(void)
// { // {
@ -29,39 +29,39 @@ ISR(SPI_STC_vect)
void setup() void setup()
{ {
Serial.begin(2000000); Serial.begin(9600);
SPI_SlaveInit(); SPI_SlaveInit();
Serial.println(); Serial.println();
Serial.println("Initialization "); Serial.println("Initialization ");
} }
void SetCommand(char *data2){ void SetCommand(char *data2, int length){
char command = data2[0]; char command = data2[0];
// Отрезать 1 элемент от оставшихся // Отрезать 1 элемент от оставшихся
char result[index];
char *ptr = &data2[1];
strcpy(result, ptr);
Serial.print("\nReceived command: "); Serial.print("\nReceived command: ");
Serial.println(command, HEX); Serial.println(command, HEX);
switch (command){ switch (command){
case 6: case 6:
AddSymbol(result); AddSymbol(&data2[1], length-1);
break; break;
} }
} }
void AddSymbol(char *symbols){ void AddSymbol(uint8_t *symbols, int lenght){
Serial.print("Received Add: "); Serial.print("Received Add: ");
// oled.setScale(3); // масштаб текста (1..4) // oled.setScale(3); // масштаб текста (1..4)
// oled.home(); // курсор в 0,0 // oled.home(); // курсор в 0,0
// oled.print("Привет!"); // oled.print("Привет!");
for(int i = 0; i < index - 1; i++) { for(int i = 0; i < lenght - 1; i++) {
Serial.print(symbols[i], HEX); char str[3];
sprintf(str, "%01X", symbols[i]);
Serial.print(str);
Serial.print(" "); Serial.print(" ");
} }
} }
@ -88,10 +88,12 @@ void AddSymbol(char *symbols){
// } // }
// Вывод массива // Вывод массива
void arrayOut(char *arr,int size){ void arrayOut(uint8_t *arr, int size){
Serial.print("Array: "); Serial.print("Array: ");
for(int i = 0; i < size;i++){ for(int i = 0; i < size;i++){
Serial.print(arr[i], HEX); char str[3];
sprintf(str, "%02X", arr[i]);
Serial.print(str);
Serial.print(" "); Serial.print(" ");
} }
Serial.println("."); Serial.println(".");
@ -112,30 +114,35 @@ void loop() {
if(PINB & (1 << 2)){ if(PINB & (1 << 2)){
if(index > 0){ if(index > 0){
arrayOut(data, index);
char sum = 0; char sum = 0;
sum = CRC8(data, index-1); sum = crc8(data, index-1);
char checkNull = 0; char checkNull = 0;
char last_1 = data[index - 1]; char last_1 = data[index - 1];
arrayOut(data, index);
Serial.println(sum, HEX);
if (last_1 == sum){ if (last_1 == sum){
Serial.println(); Serial.println();
Serial.println("Старт вывода массивов"); Serial.println("Старт вывода массивов");
Serial.println(sum, HEX); Serial.println(sum, HEX);
checkNull = checkArray(data, index); // checkNull = checkArray(data, index);
if(checkNull == 1){ // if(checkNull == 1){
SetCommand(data);
}
// }
SetCommand(data, index);
Serial.println("Стоп вывода массивов"); Serial.println("Стоп вывода массивов");
index = 0; index = 0;
return; return;
} }else{
Serial.println("Nothing ..."); Serial.println("Nothing ...");
index = 0; index = 0;
} }
}
} }
} }