58 lines
1.8 KiB
C
58 lines
1.8 KiB
C
#include "system/task_crc.h"
|
|
#include "system/data_channel.h"
|
|
#include "system/float_word.h"
|
|
#include <stdio.h>
|
|
|
|
|
|
// Funktion zur Berechnung des CRC32
|
|
void berechne_crc32(uint32_t data, uint32_t * crc);
|
|
void crc32( uint32_t data, uint32_t* crc );
|
|
|
|
int task_crc_run( void * task ) {
|
|
crc_config * config = (crc_config*) task;
|
|
uint32_t value = config->start;
|
|
// Nachfolgende Antworten Lesen den FIFO der ersten Datenquelle aus und multiplizieren
|
|
// den jeweils gelesenen Wert mit 4 und speichern das Ergebnis in der Datensenke
|
|
for (uint32_t i = 0; i < DATA_CHANNEL_DEPTH; ++i) {
|
|
float_word a;
|
|
data_channel_read(config->base.sources[0], (uint32_t * ) & a.value );
|
|
if (i<10) {printf("\n Input %i DATA; %x\ CRC: %x\n", i, a.word, value);}
|
|
berechne_crc32(a.word, &value); //Startwert jedes Mal, oder mit vorheriger crc starten?
|
|
if (i<10) {printf("\n CRC Zwischenwert Output(%i): %x\n", i, value);}
|
|
}
|
|
printf("CRC Wert: %x\n", value);
|
|
data_channel_write( config->base.sink, value);
|
|
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
void berechne_crc32(uint32_t data, uint32_t * crc) {
|
|
uint32_t bytes[4]; //Reihenfolge richtig?
|
|
uint32_t reg32 = ~*crc;
|
|
|
|
bytes[0] = (uint32_t) (data) & 0x000000FF;
|
|
bytes[1] = (uint32_t) (data >>8) & 0x000000FF;
|
|
bytes[2] = (uint32_t) (data >>16) & 0x000000FF;
|
|
bytes[3] = (uint32_t) (data >>24) & 0x000000FF; //aufffüllen
|
|
|
|
for (uint32_t i = 0; i < 4; i++) {
|
|
//von rechts nch links
|
|
for (uint8_t j = 0; j <8; j++) {
|
|
|
|
// Prüfen, ob das am weitesten rechts stehende Bit von crc 1 ist
|
|
if ((reg32 & 1) != (bytes[i] & 1)) { //Wieso crc & 1?
|
|
reg32 = (reg32 >> 1)^CRC32POLY; // XOR mit dem Polynom
|
|
} else {
|
|
reg32 >>= 1;
|
|
}
|
|
bytes[i]>>=1;
|
|
}
|
|
*crc = reg32 ^0xFFFFFFFF;
|
|
}
|
|
}
|
|
|
|
|
|
|