Готово Контрольная сумма
This commit is contained in:
parent
6b39c55d91
commit
294a5b9ac8
@ -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);
|
||||||
|
@ -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;
|
||||||
|
}
|
||||||
|
@ -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
|
||||||
}
|
}
|
||||||
|
@ -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++) {
|
||||||
|
@ -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
|
||||||
|
@ -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;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user