#include "PatriotViperController.h"
#include "RGBController.h"
#include "RGBController_PatriotViper.h"
#include "i2c_smbus.h"
#include <vector>
#include <stdio.h>
#include <stdlib.h>

#ifdef WIN32
#include <Windows.h>
#else
#include <unistd.h>

static void Sleep(unsigned int milliseconds)
{
    usleep(1000 * milliseconds);
}
#endif

/******************************************************************************************\
*                                                                                          *
*   DetectPatriotViperControllers                                                          *
*                                                                                          *
*       Detect Patriot Viper RGB controllers on the enumerated I2C busses.                 *
*                                                                                          *
*           bus - pointer to i2c_smbus_interface where Aura device is connected            *
*           dev - I2C address of Aura device                                               *
*                                                                                          *
\******************************************************************************************/

void DetectPatriotViperControllers(std::vector<i2c_smbus_interface*> &busses, std::vector<RGBController*> &rgb_controllers)
{
    PatriotViperController* new_viper;
    RGBController_PatriotViper* new_controller;

    for (unsigned int bus = 0; bus < busses.size(); bus++)
    {
        unsigned char slots_valid = 0x00;

        for(int slot_addr = 0x50; slot_addr <= 0x57; slot_addr++)
        {
            // Test for Patriot Viper RGB SPD at slot_addr
            // This test was copied from Viper RGB software
            // Tests SPD addresses in order: 0x00, 0x40, 0x41, 0x61, 0x62, 0x63, 0x64, 0x65, 0x66, 0x67, 0x68
            busses[bus]->i2c_smbus_write_byte_data(0x36, 0x00, 0xFF);

            Sleep(1);

            if(busses[bus]->i2c_smbus_read_byte_data(slot_addr, 0x00) == 0x23)
            {
                busses[bus]->i2c_smbus_write_byte_data(0x37, 0x00, 0xFF);

                Sleep(1);

                if((busses[bus]->i2c_smbus_read_byte_data(slot_addr, 0x40) == 0x85)
                 &&(busses[bus]->i2c_smbus_read_byte_data(slot_addr, 0x41) == 0x02)
                 &&(busses[bus]->i2c_smbus_read_byte_data(slot_addr, 0x61) == 0x4D)
                 &&(busses[bus]->i2c_smbus_read_byte_data(slot_addr, 0x62) == 0x49)
                 &&(busses[bus]->i2c_smbus_read_byte_data(slot_addr, 0x63) == 0x43)
                 &&(busses[bus]->i2c_smbus_read_byte_data(slot_addr, 0x64) == 0x53)
                 &&(busses[bus]->i2c_smbus_read_byte_data(slot_addr, 0x65) == 0x59)
                 &&(busses[bus]->i2c_smbus_read_byte_data(slot_addr, 0x66) == 0x53)
                 &&(busses[bus]->i2c_smbus_read_byte_data(slot_addr, 0x67) == 0x5f)
                 &&(busses[bus]->i2c_smbus_read_byte_data(slot_addr, 0x68) == 0x44))
                {
                    slots_valid |= (1 << (slot_addr - 0x50));
                }
            }

            Sleep(1);
        }

        if(slots_valid != 0)
        {
            new_viper = new PatriotViperController(busses[bus], 0x77, slots_valid);
            new_controller = new RGBController_PatriotViper(new_viper);
            rgb_controllers.push_back(new_controller);
        }
    }

}   /* DetectPatriotViperControllers() */