#pragma once

#include "blackfin.h"

void SPIChipSelect (uint32_t* valw, uint32_t addr,  uint32_t csmask, uint32_t clkmask, uint32_t digoutmask) {

    // start point
    (*valw) = ((bus_r(addr) | csmask | clkmask) &(~digoutmask));
    bus_w (addr, (*valw));

    // chip sel bar down
    (*valw) &= ~csmask;
    bus_w (addr, (*valw));
}


void SPIChipDeselect (uint32_t* valw, uint32_t addr,  uint32_t csmask, uint32_t clkmask) {
    // chip sel bar up
    (*valw) |= csmask;
    bus_w (addr, (*valw));

    //clk down
    (*valw) &= ~clkmask;
    bus_w (addr, (*valw));

    // stop point = start point of course
    (*valw) |= csmask;
    bus_w (addr, (*valw)); //FIXME: for ctb slow adcs, might need to set it to low again
}

void sendDataToSPI (uint32_t* valw, uint32_t addr, uint32_t val, int numbitstosend, uint32_t clkmask, uint32_t digoutmask, int digofset) {
    int i = 0;
    for (i = 0; i < numbitstosend; ++i) {

        // clk down
        (*valw) &= ~clkmask;
        bus_w (addr, (*valw));

        // write data (i)
        (*valw) = (((*valw) & ~digoutmask) +                                      // unset bit
                (((val >> (numbitstosend - 1 - i)) & 0x1) << digofset));    // each bit from val starting from msb
        bus_w (addr, (*valw));

        // clk up
        (*valw) |= clkmask ;
        bus_w (addr, (*valw));
    }
}

uint32_t receiveDataFromSPI (uint32_t* valw, uint32_t addr, int numbitstoreceive, uint32_t clkmask, uint32_t readaddr) {
    uint32_t retval = 0;
    int i = 0;
    for (i = 0; i < numbitstoreceive; ++i) {

        // clk down
        (*valw) &= ~clkmask;
        bus_w (addr, (*valw));

        // read data (i)
        retval |= ((bus_r(readaddr) & 0x1) << (numbitstoreceive - 1 - i));

        // clk up
        (*valw) |= clkmask ;
        bus_w (addr, (*valw));
    }
    return retval;
}

void serializeToSPI(uint32_t addr, uint32_t val, uint32_t csmask, int numbitstosend, uint32_t clkmask, uint32_t digoutmask, int digofset) {
    if (numbitstosend == 16) {
        FILE_LOG(logDEBUG1, ("Writing to SPI Register: 0x%04x\n", val));
    } else {
        FILE_LOG(logDEBUG1, ("Writing to SPI Register: 0x%08x\n", val));
    }
    uint32_t valw;

    SPIChipSelect (&valw, addr, csmask, clkmask, digoutmask);

    sendDataToSPI(&valw, addr, val, numbitstosend, clkmask, digoutmask, digofset);

    SPIChipDeselect(&valw, addr, csmask, clkmask);
}

uint32_t serializeFromSPI(uint32_t addr, uint32_t csmask, int numbitstoreceive, uint32_t clkmask, uint32_t digoutmask, uint32_t readaddr) {

    uint32_t valw;

    SPIChipSelect (&valw, addr, csmask, clkmask, digoutmask);

    uint32_t retval = receiveDataFromSPI(&valw, addr, numbitstoreceive, clkmask, readaddr);

    SPIChipDeselect(&valw, addr, csmask, clkmask);

    if (numbitstoreceive == 16) {
        FILE_LOG(logDEBUG1, ("Read From SPI Register: 0x%04x\n", retval));
    } else {
        FILE_LOG(logDEBUG1, ("Read From SPI Register: 0x%08x\n", retval));
    }
    return retval;
}