#include <stdio.h>
#include "pico/stdlib.h"
#include "pico/cyw43_arch.h"

// プロトタイプ宣言
extern void disp_next_data(void);
extern void setup_i2c_slave(void);

int main()
{
    stdio_init_all();

    // STDIOがUSBのとき、USB認識されないことがあるのでstdio初期化の後、ちょっと待つ
    sleep_ms(3000);

    puts("\nI2C slave test");

    // LEDを使うためにwifi初期化
    if (cyw43_arch_init()) {
        printf("Wi-Fi init failed");
        return -1;
    }

    // I2Cスレーブ 初期化
    setup_i2c_slave();
    
    while (1) {
        disp_next_data();
        sleep_ms(1000);

        // ==== 生存確認用にLチカ ====
        // 現在の出力値取得
        bool led_out = cyw43_arch_gpio_get (CYW43_WL_GPIO_LED_PIN);
        // 出力反転
        cyw43_arch_gpio_put(CYW43_WL_GPIO_LED_PIN, !led_out);
    }

    return 0;
}

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


// スレーブアドレス
static const uint I2C_SLAVE0_ADDRESS = 0x17;

// ボーレート
static const uint I2C_BAUDRATE = 400000; // 400 kHz

// 使用端子
static const uint I2C_SLAVE0_SDA_PIN = 16;  //GP16(Pin21)
static const uint I2C_SLAVE0_SCL_PIN = 17;  //GP17(Pin22)

// スレーブ読み出しパラメータ
static struct
{
    uint8_t mem[16];            // 読み出しデータ
    uint8_t mem_address;        // 読み出しインデックス
} context;


// 次のデータセットの表示要求フラグ
static volatile bool DISP_REQ = false;


// 次のデータセットの表示
void disp_next_data(void)
{
    if (DISP_REQ) {
        // 表示要求あり
        DISP_REQ = false;
        printf("NEXT: %02x %02x %02x %02x : %02x %02x %02x %02x : %02x %02x %02x %02x : %02x %02x %02x %02x\n", 
                context.mem[ 0], context.mem[ 1],  context.mem[ 2], context.mem[ 3],
                context.mem[ 4], context.mem[ 5],  context.mem[ 6], context.mem[ 7],
                context.mem[ 8], context.mem[ 9],  context.mem[10], context.mem[11],
                context.mem[12], context.mem[13],  context.mem[14],  context.mem[15]
            );
    }
    return;
} 

// 読み出しデータの初期化
static void init_data(void)
{
    // 送信データの初期値をセットしておく
    for (int i = 0; i < sizeof(context.mem); i++) {
        context.mem[i] = (uint8_t)i;
    }
    
    // 次に送信するデータの表示を要求
    DISP_REQ = true;
    return;
}


// 読み出しデータの更新
static void update_data(void)
{
    for (int i = 0; i < sizeof(context.mem); i++) {
        context.mem[i]++;
    }
    
    // 次に送信するデータの表示を要求
    DISP_REQ = true;
    return;
}

// I2C ISRからのコールバック
// printfなど時間のかかる処理は使うべきではない
// 例えば、表示要求フラグを立ててメインルーチン側で表示してもらうようにするなど
static void i2c_slave_handler(i2c_inst_t *i2c, i2c_slave_event_t event) {
    switch (event) {
    case I2C_SLAVE_RECEIVE: // write event
        {
            // ライト動作はサポートしないのでとりあえず読み捨てておく
            volatile uint8_t dummy = i2c_read_byte_raw(i2c);
            (void)dummy;    // ワーニング対策
        }
        break;
    case I2C_SLAVE_REQUEST: // read event
        // 1バイト送信する
        i2c_write_byte_raw(i2c, context.mem[context.mem_address]);
        // 次の転送に備えてインデックスを更新
        context.mem_address++;
        if (context.mem_address >= sizeof(context.mem)) {
            // オーバフローしたら0にもどしておく
            context.mem_address = 0;
        }
        break;
    case I2C_SLAVE_FINISH: // ストップ/リスタートコンディション時
        // リードポインタを初期化しておく
        context.mem_address = 0;
        
        // テスト用ダミーデータなので、次の読み出しに備えて値を更新しておく
        update_data();
        
        break;
    default:
        break;
    }
}

// I2Cスレーブ初期化
void setup_i2c_slave(void) {
    printf("setup i2c slave\n");

    // 端子初期化
    gpio_init(I2C_SLAVE0_SDA_PIN);
    gpio_set_function(I2C_SLAVE0_SDA_PIN, GPIO_FUNC_I2C);
    gpio_pull_up(I2C_SLAVE0_SDA_PIN);

    gpio_init(I2C_SLAVE0_SCL_PIN);
    gpio_set_function(I2C_SLAVE0_SCL_PIN, GPIO_FUNC_I2C);
    gpio_pull_up(I2C_SLAVE0_SCL_PIN);

    // 送信データの初期値をセットしておく
    init_data();

    // I2C初期化
    i2c_init(i2c0, I2C_BAUDRATE);

    // I2Cスレーブとしての初期化
    i2c_slave_init(i2c0, I2C_SLAVE0_ADDRESS, &i2c_slave_handler);
    printf("setup i2c slave  done\n");
}