Settings.settings « Properties « Tango.MachineStudio.ActionLogs « Modules « MachineStudio « Visual_Studio « Software - Tango - Twine softwares

about summary refs log tree commit diff stats

path: root/Software/Visual_Studio/MachineStudio/Modules/Tango.MachineStudio.ActionLogs/Properties/Settings.settings

blob: 033d7a5e9e2266753180f4e3a9299f575046701e (plain)

<?xml version='1.0' encoding='utf-8'?>
<SettingsFile xmlns="uri:settings" CurrentProfile="(Default)">
  <Profiles>
    <Profile Name="(Default)" />
  </Profiles>
  <Settings />
</SettingsFile>

*/ .highlight .se { color: #0044dd; background-color: #fff0f0 } /* Literal.String.Escape */ .highlight .sh { color: #dd2200; background-color: #fff0f0 } /* Literal.String.Heredoc */ .highlight .si { color: #3333bb; background-color: #fff0f0 } /* Literal.String.Interpol */ .highlight .sx { color: #22bb22; background-color: #f0fff0 } /* Literal.String.Other */ .highlight .sr { color: #008800; background-color: #fff0ff } /* Literal.String.Regex */ .highlight .s1 { color: #dd2200; background-color: #fff0f0 } /* Literal.String.Single */ .highlight .ss { color: #aa6600; background-color: #fff0f0 } /* Literal.String.Symbol */ .highlight .bp { color: #003388 } /* Name.Builtin.Pseudo */ .highlight .fm { color: #0066bb; font-weight: bold } /* Name.Function.Magic */ .highlight .vc { color: #336699 } /* Name.Variable.Class */ .highlight .vg { color: #dd7700 } /* Name.Variable.Global */ .highlight .vi { color: #3333bb } /* Name.Variable.Instance */ .highlight .vm { color: #336699 } /* Name.Variable.Magic */ .highlight .il { color: #0000DD; font-weight: bold } /* Literal.Number.Integer.Long */

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

#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;

    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;

}