#include <p24fxxxx.h>
#include "poll.h"
#include "spi.h"

#define MAX_QUERIES 16
unsigned int queries[MAX_QUERIES][2];
unsigned char curQuery = 0;

void pollNewQuery(unsigned int command, unsigned int time)
{
    unsigned int cmd = command >> 10;
    
    if (curQuery + 1 >= MAX_QUERIES)
    {
        return;
    }
    
    switch (cmd)
    {
        case INFO_CMD: case READ_CMD: case WRITE_CMD:
        case BUFF_RET_CMD: case BUFF_CMD:
            break;
        default:
            return;
    }
    
    queries[++curQuery][0] = command;
    queries[curQuery][1] = time;
}

void pollQueries(Timer &timer)
{
    unsigned char i;
    unsigned long time = tmrRead(timer);
    
    for (i = 0;i < curQuery; i++)
    {   
        if (time % queries[i][1] == 0) {
            
        }
    }
}