/************************************************************************************************************************
 **************************************************************************************************************************/

#include <DataDef.h>
#include "include.h"

#include "ids.h"
#include "PMR/common/MessageContainer.pb-c.h"
#include "PMR/Hardware/HardwareDispenser.pb-c.h"
#include "PMR/Hardware/HardwarePidControl.pb-c.h"
#include "PMR/Printing/JobSpool.pb-c.h"
#include "PMR/Printing/JobSpoolType.pb-c.h"

#include "drivers/Motors/Motor.h"
#include "drivers/ADC_Sampling/adc.h"

#define MAX_CONTROL_SAMPLES 10

HardwareDispenser DispensersCfg[ MAX_SYSTEM_DISPENSERS];

TimerMotors_t DispenserIdToMotorId[MAX_SYSTEM_DISPENSERS] = {HARDWARE_MOTOR_TYPE__MOTO_DISPENSER_1,HARDWARE_MOTOR_TYPE__MOTO_DISPENSER_2,HARDWARE_MOTOR_TYPE__MOTO_DISPENSER_3,HARDWARE_MOTOR_TYPE__MOTO_DISPENSER_4,HARDWARE_MOTOR_TYPE__MOTO_DISPENSER_5,HARDWARE_MOTOR_TYPE__MOTO_DISPENSER_6,HARDWARE_MOTOR_TYPE__MOTO_DISPENSER_7,HARDWARE_MOTOR_TYPE__MOTO_DISPENSER_8};

float DispenserPressure[MAX_SYSTEM_DISPENSERS] = {0};

float GetDispenserPressure(int DispenserId)
{
    return DispenserPressure[DispenserId];
}
float Vlow,VHigh,Bits_0Pascal,Bits_1MPascal,a,b;
void Calculateinit (void)
{
    Vlow = 0.004 * 130; // 4mA*130ohm  = 0.52 V(0 Pascal)
    VHigh = 0.020 *130; // 20mA*130ohm  = 2.6V (1M Pascal)

    Bits_0Pascal = Vlow * 4096 / 3; // Vlow * 4096bit / 3Vref = 709.973328 bits
    Bits_1MPascal = VHigh * 4096 / 3; // VHigh * 4096bit / 3Vref = 3549.86646 bits

    a = (1 - 0) / (Bits_1MPascal - Bits_0Pascal);// Mpascal/Bits = 0.000352125

    b = 0 - (a * Bits_0Pascal ); // y = ax + b (x= Bits_0Pascal, y = 0)

}
float CalculateDispenserPressure (int DispenserId)
{
    unsigned short data = 0;
    float temp = 0.0;

/*
    data = ADC_GetReading(DispenserIdToPressureSensorId[DispenserId]);
    temp = 4096 - data;
    temp *= 3;
    temp *= 1000; //move to mv
    temp /= 4096;
    DispenserPressure[DispenserId] = 3000 - temp;
    */
    data = ADC_GetReading(DispenserIdToPressureSensorId[DispenserId]);

    if(data<Bits_0Pascal)
        data = Bits_0Pascal;//40mA 0Bar

    temp = a * data + b;

    DispenserPressure[DispenserId] = temp; // [Mpascal] ( 1 Mpascal = 10 Bar )

    //unmark one of them to convert from Mpascal to :
    //-----------------------------------
    //DispenserPressure[DispenserId] /= 1000000; //Pascal
    //DispenserPressure[DispenserId] *=10;        //Bar;
    //DispenserPressure[DispenserId] *=10000000;        //uBar;
    //DispenserPressure[DispenserId] *=145.0377;  //PSI;

    DispenserPressure[DispenserId] *= 10; //MPascal -> Bar

    return(DispenserPressure[DispenserId]);
}


uint32_t DispenserConfigMessage(HardwareDispenser * request)
{
    uint32_t status = PASSED;
    int Dispenser_i;

    Dispenser_i = request->hardwaredispensertype;
    if (Dispenser_i< MAX_SYSTEM_DISPENSERS)
    {
        memcpy (&DispensersCfg[Dispenser_i],request,sizeof(HardwareDispenser));
        return status;
    }
    else return Dispenser_i;

}