#include <stdio.h>
#include "pico/stdlib.h"
#include "stdlib.h"
#include "hardware/i2c.h"

#define I2C_ADDR 0x68
#define GPIO_SDA 4
#define GPIO_SCL 5

void setup_i2c(){
  i2c_init(i2c0, 100 * 1000);
  gpio_set_function(GPIO_SDA, GPIO_FUNC_I2C);
  gpio_set_function(GPIO_SCL, GPIO_FUNC_I2C);
  gpio_pull_up(GPIO_SDA);
  gpio_pull_up(GPIO_SCL);  
}

int main(){

  stdio_init_all();
  setup_i2c();

  uint8_t val = 24;
  i2c_write_blocking(i2c_default, I2C_ADDR, val, 1, true);

  uint8_t buffer[2];

  while(true){
    i2c_read_blocking(i2c0, I2C_ADDR, val, 2, false);
    uint16_t valor = (buffer[0] << 8) | buffer[1];
    printf("Valor lido: %d\n", val);
    sleep_ms(1000);
  }
}