File content as of revision 0:a2bbc478f812:

// @autor: jeremie@wizzilab.com
// @date: 2017-12-14

#include "DebouncedInterrupt.h"
#include "modem_ref_helper.h"
#include "modem_callbacks.h"
#include "files.h"
#include "crc.h"

#define MIN(a,b)                ((a<b)?a:b)

#define MY_POLICY_IDX           0
#define FID_OUTPUT_FILE         200
#define CHUNK_SIZE              128

Semaphore button_user(0);
Semaphore modem_ready(0);
Queue<void, 8> modem_resp[MAX_USER_NB];
Queue<touch_t, 8> g_file_modified;

enum {
    MODEM_RESP_NO,
    MODEM_RESP_TERMINAL,
    MODEM_RESP_ERROR,
    MODEM_RESP_ACK,
    MODEM_RESP_TIMEOUT,
};

const input_file_t output_file = {
    .data = "Lorem ipsum dolor sit amet, consectetur adipiscing elit. Donec id pulvinar est. Mauris pretium arcu at facilisis rutrum. Nulla facilisi. "
            "Quisque auctor, massa et gravida semper, libero dui varius est, quis ornare dolor odio a turpis. Suspendisse in turpis vel risus porta "
            "aliquet et a nibh. Mauris vehicula purus ut risus convallis, id luctus erat tincidunt. Aenean vitae gravida nisi. Nulla eleifend lorem "
            "purus, non sagittis neque accumsan molestie.\n"
            "\n"
            "Praesent interdum semper viverra. Cras ut sodales quam. Etiam vitae orci sit amet lorem semper commodo. Phasellus elementum nec dui eget "
            "pellentesque. Proin eget dignissim nibh. In iaculis imperdiet enim, consequat gravida mi varius sed. Suspendisse eu elementum justo. "
            "Donec non mauris odio. Sed aliquet vestibulum risus non ultricies. Integer mollis neque id magna gravida auctor. Cras at auctor velit. "
            "Vivamus tempor dui purus, id commodo arcu iaculis a. Curabitur hendrerit, nibh sit amet gravida porttitor, leo magna gravida ex, non "
            "porta ligula quam ac risus. Maur",
    // Used only to know size and offset
    .crc = 0,
}
                        


alp_retry_policy_t my_policy = {
    .meta.procedure     = 0,
    .meta.respond       = true,
    .meta.persistant    = false,
    .meta.bulk          = false,
    .depth              = 1,
    .retries            = 0,
    .slot_time          = 0
};

alp_d7a_itf_t my_itf = {
    .type                           = ALP_ITF_TYPE_D7A,
    .cfg.to                         = 0,
    .cfg.te                         = 0,
    .cfg.qos.bf.resp                = D7A_RESP_PREFERRED,
    .cfg.qos.bf.retry               = MY_POLICY_IDX,
    .cfg.qos.bf.record              = 0,
    .cfg.qos.bf.stop_on_err         = 0,
    .cfg.addressee.ctrl.bf.nls      = D7A_NLS_AES_CCM_64,
    .cfg.addressee.ctrl.bf.idf      = D7A_ID_NBID,
    .cfg.addressee.xcl.bf           = {.s = 0x0, .m = 0x1},// XXX D7A_XCL_GW,
    .cfg.addressee.id[0]            = 4,
};

void print_resp(uint8_t id, int status)
{
    switch (status)
    {
        case ALP_ERR_NONE:
            //PRINT("Resp[%d]: OK\n", id);
            break;
        case ALP_ERR_FILE_EXIST:
            PRINT("Resp[%d]: Already registered\n", id);
            break;
        default:
            PRINT("Resp[%d]: error %d\n", id, status);
            break;
    }
}

// Callback for broadcast read
void my_response_callback(uint8_t terminal, int8_t err, uint8_t id)
{
    (void)id;
    
    print_resp(id, err);

    if (terminal)
    {
        modem_resp[id].put((void*)MODEM_RESP_TERMINAL);
    }
    else
    {
        if (ALP_ERR_NONE == err)
        {
            modem_resp[id].put((void*)MODEM_RESP_ACK);
        }
        else
        {
            modem_resp[id].put((void*)MODEM_RESP_ERROR);
        }
    }
}

// Interrupt Service Routine on button press.
void button_push_isr( void )
{
    button_user.release();
}

void button_user_thread()
{
    FPRINT("(id:0x%08x)\r\n", osThreadGetId());

    osEvent evt;
    uint32_t resp;
    d7a_sp_res_t istat;
    uint32_t sent = 0;
    uint8_t chunk[CHUNK_SIZE];

    uint8_t id = modem_get_id(my_response_callback);
        
    memset(&istat, 0, sizeof(d7a_sp_res_t));
    
    while (true)
    {
        Timer tim;
        bool is_ok;
                
        // Calculate CRC
        uint32_t crc = calculate_crc32(output_file, sizeof(output_file));

        // Wait for button press
        PRINT("Press user button to send file.\n");
        button_user.wait();
        
        sent = 0;
        tim.start();
        
        // Send chunks
        while (sent < sizeof(output_file))
        {
            is_ok = false;
            uint32_t chunk_size = MIN(sizeof(chunk), sizeof(output_file) - sent);
            uint32_t chunk_offset = sent;
            
            memcpy(chunk, &(output_file[chunk_offset]), chunk_size);
            
            PRINT("Sending chunk %4d/%4d (%3d bytes)... ", chunk_offset, sizeof(output_file), chunk_size);
            FLUSH();
            modem_send_file_content((uint8_t*)&my_itf, D7_ITF_SIZE(&my_itf), (void*)&istat, FID_OUTPUT_FILE, chunk, chunk_offset, chunk_size, id);
            
            do
            {
                evt = modem_resp.get(3000);
                resp = (evt.status == osEventMessage)? (uint32_t)evt.value.p : MODEM_RESP_TIMEOUT;
                
                if (MODEM_RESP_ACK == resp)
                {
                    //PRINT_DATA("ACK UID:", "%02X", istat.addressee.id, 8, " ");
                    //PRINT("SNR:%d dB RXLEV:%d dBm LB:%d dB\n", istat.snr, -istat.rxlev, istat.lb);
                    
                    //PRINT("ACK.\n");
                    is_ok = true;
                }
                else if (MODEM_RESP_TIMEOUT == resp)
                {
                    PRINT("TIMEOUT.\n");
                }
                else if (MODEM_RESP_ERROR == resp)
                {
                    //PRINT("ERROR.\n");
                    break;
                }
                else if (MODEM_RESP_TERMINAL == resp)
                {
                    //PRINT("DONE.\n");
                }
                
                memset(&istat, 0, sizeof(d7a_sp_res_t));
            } while (MODEM_RESP_TERMINAL != resp);
            
            if (is_ok)
            {
                sent += chunk_size;
                PRINT("OK.\n");
            }
            else
            {
                PRINT("FAILED.\n");
                break;
            }
        }
        
        double time_s = tim.read();
        if (sent)
        {
            PRINT("%d bytes sent in %.3fs (%d B/s)\n", sent, time_s, (int)((double)sent/time_s));
        }
        
        if (is_ok)
        {
            // Send CRC
            PRINT("Sendind CRC 0x%08X\n", crc);
            modem_send_file_content((uint8_t*)&my_itf, D7_ITF_SIZE(&my_itf), (void*)&istat, FID_OUTPUT_FILE, &crc, offsetof(input_file_t, crc), sizeof_field(input_file_t, crc), id);
            
            do
            {
                evt = modem_resp[id].get(3000);
                resp = (evt.status == osEventMessage)? (uint32_t)evt.value.p : MODEM_RESP_TIMEOUT;
                
                if (MODEM_RESP_ACK == resp)
                {
                    PRINT_DATA("ACK UID:", "%02X", istat.addressee.id, 8, " ");
                    PRINT("SNR:%d dB RXLEV:%d dBm LB:%d dB\n", istat.snr, -istat.rxlev, istat.lb);
                }
                else if (MODEM_RESP_TIMEOUT == resp)
                {
                    PRINT("TIMEOUT.\n");
                }
                else if (MODEM_RESP_ERROR == resp)
                {
                    PRINT("ERROR.\n");
                    break;
                }
                else if (MODEM_RESP_TERMINAL == resp)
                {
                    PRINT("DONE.\n");
                }
                
                memset(&istat, 0, sizeof(d7a_sp_res_t));
            } while (MODEM_RESP_TERMINAL != resp);
        }
    }
}

void thread_file_modified()
{
    touch_t* touch;
    osEvent evt;
    uint8_t chunk[CHUNK_SIZE];
    
    uint8_t id = modem_get_id(my_response_callback);
    
    while (true)
    {
        evt = g_file_modified.get();
        touch = (evt.status == osEventMessage)? (touch_t*)evt.value.p : NULL;
        ASSERT(touch != NULL, "NULL touch pointer!\n");
        
        switch (touch->fid)
        {
            case FID_INPUT_FILE:
                PRINT("Got chunk %4d/%4d (%3d bytes)\n", touch->offset, sizeof_field(input_file_t, data), touch->length);
                ram_fs_read(touch->fid, touch->offset, touch->length, chunk);
                PRINT("%s\n", chunk);
                
                // Check if CRC has been updated
                if ((touch->offset == offsetof(input_file_t, crc)) && (touch->length == sizeof_field(input_file_t, crc)))
                {
                    input_file_t input;
                    
                    // Read file
                    ram_fs_read(touch->fid, 0, sizeof(input_file_t), input);
                    
                    // Calculate and compare CRC
                    uint32_t crc = calculate_crc32(input.data, strlen(input.data));
                    
                    PRINT("INPUT CRC 0x%08X CRC 0x%08X\n", input.crc, crc);
                    
                    if (input.crc != crc)
                    {
                        // delete CRC
                        input.crc = 0;
                    }
                    
                    // Send CRC as confirmation
                    PRINT("COMFIRM CRC 0x%08X\n", input.crc);
                    modem_send_file_content((uint8_t*)&my_itf, D7_ITF_SIZE(&my_itf), (void*)&istat, FID_INPUT_FILE, &input.crc, offsetof(input_file_t, crc), sizeof_field(input_file_t, crc), id);
                    
                    do
                    {
                        evt = modem_resp[id].get(3000);
                        resp = (evt.status == osEventMessage)? (uint32_t)evt.value.p : MODEM_RESP_TIMEOUT;
                        
                        if (MODEM_RESP_ACK == resp)
                        {
                            PRINT_DATA("ACK UID:", "%02X", istat.addressee.id, 8, " ");
                            PRINT("SNR:%d dB RXLEV:%d dBm LB:%d dB\n", istat.snr, -istat.rxlev, istat.lb);
                        }
                        else if (MODEM_RESP_TIMEOUT == resp)
                        {
                            PRINT("TIMEOUT.\n");
                        }
                        else if (MODEM_RESP_ERROR == resp)
                        {
                            PRINT("ERROR.\n");
                            break;
                        }
                        else if (MODEM_RESP_TERMINAL == resp)
                        {
                            PRINT("DONE.\n");
                        }
                        
                        memset(&istat, 0, sizeof(d7a_sp_res_t));
                    } while (MODEM_RESP_TERMINAL != resp);
                }
                break;
            default:
                PRINT("TOUCH FID %d OFF %d LEN %d\n", touch->fid, touch->offset, touch->length);
                break;
        }
        
        FREE(touch);
    }
}

modem_callbacks_t callbacks = {
    .read       = my_read,
    .write      = my_write,
    .read_fprop = my_read_fprop,
    .flush      = my_flush,
    .remove     = my_delete,
    .udata      = my_udata,
    .lqual      = my_lqual,
    .ldown      = my_ldown,
    .reset      = my_reset,
    .boot       = my_boot
};

// Callback
void my_main_callback(uint8_t terminal, int8_t err, uint8_t id)
{
    (void)id;
    
    if (terminal)
    {
        print_status(err);
        modem_ready.release();
    }
    else
    {
        print_resp(err);
    }
}

/*** Main function ------------------------------------------------------------- ***/
int main() {
    // Start & initialize
#ifdef DEBUG_LED
    DBG_OPEN(DEBUG_LED);
#else
    DBG_OPEN(NC);
#endif
    PRINT("\n"
          "-----------------------------------------\n"
          "------------- Demo Big File -------------\n"
          "-----------------------------------------\n");
          
    FPRINT("(id:0x%08x)\r\n", osThreadGetId());
    
    modem_helper_open(&callbacks);
    
    uint8_t id = modem_get_id(my_main_callback);
    
    // Set custom retry policy
    // XXX Won't work the first time as we need to reboot the modem for the changes to be applied
    
    modem_write_file(WM_FID_ALP_CFG, &my_policy, MY_POLICY_IDX * sizeof(alp_retry_policy_t), sizeof(alp_retry_policy_t), id);
    modem_ready.wait();
    modem_flush_file(WM_FID_ALP_CFG, id);
    modem_ready.wait();
    
    PRINT("Register Files\n");
    // HOST Revision is a local file. Uses D7AActP Notification.
    modem_update_file(FID_HOST_REV, (alp_file_header_t*)&h_rev, (uint8_t*)&f_rev);
    modem_update_file(FID_INPUT_FILE, (alp_file_header_t*)&h_input_file, (uint8_t*)&f_input_file);
    
    PRINT("Start D7A Stack\n");
    modem_activate_itf(ALP_ITF_TYPE_D7A, 24, 0, ALP_D7A_ISTAT_RESP | ALP_D7A_ISTAT_UNS, true, id);
    modem_ready.wait();
    
    PRINT("Notify Modem Version\n");
    modem_notify_file(D7A_FID_FIRMWARE_VERSION, 0, SIZE_HOST_REV, id);
    modem_ready.wait();
    
    PRINT("Notify Host Version\n");
    modem_notify_file(FID_HOST_REV, 0, SIZE_HOST_REV, id);
    modem_ready.wait();
    
    // id no longer needed
    modem_free_id(id);
    
    // Start file modified thread
    Thread th_file_modified(osPriorityNormal, 1024, NULL);
    osStatus status = th_file_modified.start(thread_file_modified);
    ASSERT(status == osOK, "Failed to start thread_file_modified (err: %d)\r\n", status);

#ifdef DEBUG_BUTTON
    DebouncedInterrupt user_interrupt(DEBUG_BUTTON);
    user_interrupt.attach(button_push_isr, IRQ_FALL, 500, true);
    
    Thread but_th(osPriorityNormal, 4096, NULL);
    status = but_th.start(button_user_thread);
    ASSERT(status == osOK, "Failed to start but thread (err: %d)\r\n", status);
#else
    #error You need a button to use this APP as is
#endif

#ifdef DEBUG_LED
    DigitalOut my_led(DEBUG_LED);
#endif
    
    // Set main task to lowest priority
    osThreadSetPriority(osThreadGetId(), osPriorityIdle);
    while(true)
    {
        Thread::wait(500);
#ifdef DEBUG_LED
        my_led = !my_led;
#endif
    }
}