#include <Arduino.h>

void core1_entry() {
	while (true) {
		float temp = analogReadTemp();

		uint32_t temp_bits;
		memcpy(&temp_bits, &temp, sizeof(temp_bits));
		rp2040.fifo.push(temp_bits); // push en lugar de push_blocking

		delay(1000);
	}
}

void setup() {
	Serial.begin(115200);
	delay(5000);

	rp2040.fifo.begin(2); // begin(2) = usar ambos cores
	multicore_launch_core1(core1_entry);

	Serial.println("Sistema dual-core iniciado");
	Serial.println("Core 0: imprime | Core 1: mide temperatura");
}

void loop() {
	uint32_t temp_bits;

	if (rp2040.fifo.pop_nb(&temp_bits)) { // pop no bloqueante
		float temperature;
		memcpy(&temperature, &temp_bits, sizeof(temperature));
		Serial.printf("Core temperature: %2.1fC\n", temperature);
	}

	delay(100);
}