Files
RP2040-Decoder/multicore.c
T

140 lines
2.9 KiB
C

/**
* Copyright (c) 2020 Raspberry Pi (Trading) Ltd.
*
* SPDX-License-Identifier: BSD-3-Clause
*/
#include <stdio.h>
#include <stdlib.h>
#include <inttypes.h>
#include "pico/stdlib.h"
#include "pico/multicore.h"
#include "hardware/gpio.h"
#include "automat.h"
bool readBit()
{
busy_wait_us_32(87);
return !gpio_get(17);
}
void printer(char buf[100]){
while (*buf) {
multicore_fifo_push_blocking(*buf);
buf++;
}
}
uint32_t errorcount = 0;
#define FLAG_VALUE 123
void pretty_print(char* s){
char addresse[9];
s+=11;
for (int i = 0; i < 8 ; i++) {
addresse[i] = *(s+i);
}
addresse[8] =0;
s+=9;
char befehl[9];
for (int i = 0; i < 8 ; i++) {
befehl[i] = *(s+i);
}
befehl[8] =0;
s+=9;
char pruef[9];
for (int i = 0; i < 8 ; i++) {
pruef[i] = *(s+i);
}
s+=8;
pruef[8] =0;
static int32_t counter = 1;
printf("%d address: %s befehl: %s pruef: %s %c\n", counter++, addresse, befehl, pruef, *s);
}
void core1_entry() {
multicore_fifo_push_blocking(FLAG_VALUE);
int index = 0;
char buf[100] = {0};
while (1) {
buf[index] = multicore_fifo_pop_blocking();
if (buf[index] == '\n' || index == 99) {
pretty_print(buf);
for(int i =0 ; i < 100; i++) {
buf[i] = 0;
}
index = -1;
}
index++;
}
}
const int SIZE = 10 + 1 + 13 * 9 + 1 + 1;
#define LEFTESTBIT 0x8000000000000000
char* genCharArray(uint64_t last_read_bits, uint64_t mask);
void gpio_callback_rise(uint gpio, uint32_t events) {
static uint64_t last_read_Bits;
static uint64_t mask = LEFTESTBIT;
bool last_read_bit = readBit();
if (last_read_bit) {
last_read_Bits = last_read_Bits | mask;
} else {
last_read_Bits = last_read_Bits & ~mask;
}
if ( mask == 1) {
mask = LEFTESTBIT;
} else {
mask >>= 1;
}
char * s = genCharArray(last_read_Bits, mask);
if (fsm_main(s) == 1) {
s[SIZE-2 ] ='\n';
s[SIZE-1 ] =0;
printer(s);
}
free(s);
}
char* genCharArray(uint64_t last_read_bits, uint64_t mask) {
char *s = malloc(SIZE);
for ( int i = SIZE-3; i >= 0 ; i-- ) {
if ( mask == LEFTESTBIT ){
mask = 1;
} else {
mask <<= 1;
}
s[i] = last_read_bits & mask ? '1': '0';
}
s[SIZE-2 ] =0;
return s;
}
int main() {
stdio_init_all();
multicore_launch_core1(core1_entry);
// Wait for it to start up
uint32_t g = multicore_fifo_pop_blocking();
if (g != FLAG_VALUE)
printf("Hmm, that's not right on core 0!\n");
else {
printf("It's all gone well on core 0!");
}
gpio_init(17);
gpio_set_dir(17, GPIO_IN);
gpio_set_irq_enabled_with_callback(17, GPIO_IRQ_EDGE_RISE, true, &gpio_callback_rise);
while(1) {
;
}
/// \end::setup_multicore[]
}