#include <stdio.h>
#include "ad5940.h"
#include "ad5941_port.h"
#include "freertos/FreeRTOS.h"
#include "freertos/task.h"

#define AD5941_EXPECTED_ADIID   0x4144

void app_main(void)
{
    printf("EIS4: AD5941 bring-up\n");

    AD5940_MCUResourceInit(NULL);
    AD5940_HWReset();
    AD5940_Initialize();

    uint32_t adiid  = AD5940_ReadReg(REG_AFECON_ADIID);
    uint32_t chipid = AD5940_ReadReg(REG_AFECON_CHIPID);

    printf("ADIID : 0x%04lX  %s\n", adiid,
           adiid == AD5941_EXPECTED_ADIID ? "(OK)" : "(UNEXPECTED)");
    printf("CHIPID: 0x%04lX\n", chipid);

    if (adiid != AD5941_EXPECTED_ADIID)
        printf("FAIL: cannot communicate with AD5941 — check SPI wiring\n");
    else
        printf("AD5941 alive and responding\n");
}