aboutsummaryrefslogtreecommitdiffstats
path: root/Software/Embedded_SW/Embedded/Modules/Stubs_Handler/Progress.c
blob: 0575f038894e56f33ba5ddbbfc225c6bae9e53e7 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
1
/* Generated by the protocol buffer compiler.  DO NOT EDIT! */
/* Generated from: SetHeaterStateRequest.proto */

/* Do not generate deprecated warnings for self */
#ifndef PROTOBUF_C__NO_DEPRECATED
#define PROTOBUF_C__NO_DEPRECATED
#endif

#include "SetHeaterStateRequest.pb-c.h"
void   set_heater_state_request__init
                     (SetHeaterStateRequest         *message)
{
  static const SetHeaterStateRequest init_value = SET_HEATER_STATE_REQUEST__INIT;
  *message = init_value;
}
size_t set_heater_state_request__get_packed_size
                     (const SetHeaterStateRequest *message)
{
  assert(message->base.descriptor == &set_heater_state_request__descriptor);
  return protobuf_c_message_get_packed_size ((const ProtobufCMessage*)(message));
}
size_t set_heater_state_request__pack
                     (const SetHeaterStateRequest *message,
                      uint8_t       *out)
{
  assert(message->base.descriptor == &set_heater_state_request__descriptor);
  return protobuf_c_message_pack ((const ProtobufCMessage*)message, out);
}
size_t set_heater_state_request__pack_to_buffer
                     (const SetHeaterStateRequest *message,
                      ProtobufCBuffer *buffer)
{
  assert(message->base.descriptor == &set_heater_state_request__descriptor);
  return protobuf_c_message_pack_to_buffer ((const ProtobufCMessage*)message, buffer);
}
SetHeaterStateRequest *
       set_heater_state_request__unpack
                     (ProtobufCAllocator  *allocator,
                      size_t               len,
                      const uint8_t       *data)
{
  return (SetHeaterStateRequest *)
     protobuf_c_message_unpack (&set_heater_state_request__descriptor,
                                allocator, len, data);
}
void   set_heater_state_request__free_unpacked
                     (SetHeaterStateRequest *message,
                      ProtobufCAllocator *allocator)
{
  if(!message)
    return;
  assert(message->base.descriptor == &set_heater_state_request__descriptor);
  protobuf_c_message_free_unpacked ((ProtobufCMessage*)message, allocator);
}
static const ProtobufCFieldDescriptor set_heater_state_request__field_descriptors[3] =
{
  {
    "HeaterType",
    1,
    PROTOBUF_C_LABEL_OPTIONAL,
    PROTOBUF_C_TYPE_ENUM,
    offsetof(SetHeaterStateRequest, has_heatertype),
    offsetof(SetHeaterStateRequest, heatertype),
    &heater_type__descriptor,
    NULL,
    0,             /* flags */
    0,NULL,NULL    /* reserved1,reserved2, etc */
  },
  {
    "SetPoint",
    2,
    PROTOBUF_C_LABEL_OPTIONAL,
    PROTOBUF_C_TYPE_DOUBLE,
    offsetof(SetHeaterStateRequest, has_setpoint),
    offsetof(SetHeaterStateRequest, setpoint),
    NULL,
    NULL,
    0,             /* flags */
    0,NULL,NULL    /* reserved1,reserved2, etc */
  },
  {
    "IsActive",
    3,
    PROTOBUF_C_LABEL_OPTIONAL,
    PROTOBUF_C_TYPE_BOOL,
    offsetof(SetHeaterStateRequest, has_isactive),
    offsetof(SetHeaterStateRequest, isactive),
    NULL,
    NULL,
    0,             /* flags */
    0,NULL,NULL    /* reserved1,reserved2, etc */
  },
};
static const unsigned set_heater_state_request__field_indices_by_name[] = {
  0,   /* field[0] = HeaterType */
  2,   /* field[2] = IsActive */
  1,   /* field[1] = SetPoint */
};
static const ProtobufCIntRange set_heater_state_request__number_ranges[1 + 1] =
{
  { 1, 0 },
  { 0, 3 }
};
const ProtobufCMessageDescriptor set_heater_state_request__descriptor =
{
  PROTOBUF_C__MESSAGE_DESCRIPTOR_MAGIC,
  "SetHeaterStateRequest",
  "SetHeaterStateRequest",
  "SetHeaterStateRequest",
  "",
  sizeof(SetHeaterStateRequest),
  3,
  set_heater_state_request__field_descriptors,
  set_heater_state_request__field_indices_by_name,
  1,  set_heater_state_request__number_ranges,
  (ProtobufCMessageInit) set_heater_state_request__init,
  NULL,NULL,NULL    /* reserved[123] */
};
810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079
#include <Container.h>
#include <PMR/Common/MessageContainer.pb-c.h>
#include <PMR/Stubs/ProgressRequest.pb-c.h>
#include <PMR/Stubs/ProgressResponse.pb-c.h>
#include "include.h"
#include "driverlib/gpio.h"

#include "Communication/Connection.h"

#include "Drivers/USB_Communication/USBCDCD.h"
#include "StateMachines/Initialization/PowerOffSequence.h"
#include "StateMachines/Initialization/PowerIdle.h"

#include "drivers/Flash_Memory/FATFS/ff.h"
#include "drivers/Flash_Memory/FATFS/Control_File_System.h"
#include "drivers/Flash_ram/FlashProgram.h"
#include "drivers/adc_sampling/adc.h"
#include "drivers/Heater/TemperatureSensor.h"
#include "drivers/ADC_Sampling/adc.h"
#include "drivers/Flash_ram/MCU_E2Prom.h"
#include "Drivers/SSI_Comm/Dancer/Dancer.h"

#include "Drivers/I2C_Communication/Head_Card/PT100/Head_PT100_ADC.h"
#include "Drivers/I2C_Communication/Head_Card/Fan/fan_click.h"
#include "Drivers/I2C_Communication/Head_Card/Fan/Head_Fan.h"
#include "drivers/Motors/Motor.h"
#include "drivers/FPGA/FPGA_SPI_Comm.h"
#include "Modules/IFS/ifs.h"
#include "Modules/IDS/ids_ex.h"
#include "Modules/Control/MillisecTask.h"
#include "modules/thread/thread_ex.h"
#include "modules/heaters/heaters_ex.h"
#include <Drivers/I2C_Communication/I2C.h>
#include <Drivers/I2C_Communication/Head_Card/I2C_Head_Mux.h>
#include "Drivers/I2C_Communication/Head_Card/IO_Ports/Head_IO.h"
#include "drivers/adc_sampling/adc.h"
#include <Drivers/I2C_Communication/WHS_Card/D_EMC2302_Fan/WHS_Fan.h>
#include <Drivers/I2C_Communication/WHS_Card/WHS_data.h>
#include <Drivers/I2C_Communication/I2C_Task.h>
#include <Drivers/I2C_Communication/WHS_Card/D_AD5272_Rheostat/WHS_Rheostat.h>
#include <Drivers/I2C_Communication/WHS_Card/D_Max5805_ADC_Blower/WHS_Blower.h>
#include <Drivers/I2C_Communication/WHS_Card/D_MAX11614_ADC/WHS_MAX11614_A2D.h>
#include <Drivers/I2C_Communication/WHS_Card/IO_Extender_Ports_TCA9555/WHS_IO.h>


#include "Drivers/I2C_Communication/Dispenser_Card/EEPROM/Dispenser_EEPROM.h"

#include "drivers/Uart_Comm/WHS_Controller_Comm/WHS_UART/WHS_Uart.h"
#include <Drivers/I2C_Communication/WHS_Card/IO_Extender_Ports_TCA9555/WHS_IO.h>

#include "drivers/Heater/TemperatureSensor.h"
#include "Drivers/I2C_Communication/Head_Card/PT100/ADS122X04.h"

extern HeadBoardTempSensConfigStruc  HeadTempSensConfig[MAX_HEAD_CARD_TEMP_SENS_ID];
extern float NumberOfRotationPerPassage;  // how many rotations per spool passage
extern void HeaterSafetyTestSetLimits(int limit);

//#include "graphics_adapter.h"
extern uint8_t Input_Voltage;
extern uint8_t Test_Read_Buf[4];

extern uint8_t Head_Fan_PWM_Command[2];
extern uint16_t Head_Fan_Tach[2];

bool RestartNeeded = false;

void Stub_ProgressRequest(MessageContainer* requestContainer)
{
    MessageContainer responseContainer;

    ProgressRequest* request = progress_request__unpack(NULL, requestContainer->data.len, requestContainer->data.data);

    //writeLine("Progress Request...");

    ProgressResponse response = PROGRESS_RESPONSE__INIT;

//    uint8_t high_byte = 0;
//    uint8_t low_byte = 0;

    uint8_t addr = 0;
    uint8_t port = 0;
    uint8_t pin  = 0;
    uint8_t value= 0;

    uint8_t ReadBackReg[1];

    if(request->amount == 0xC04f)
    {

        switch(request->delay)
        {
            case 0x8400:
                    HeadADCPT100_ReadReg(HEAD_PT100_ZONE_5_0X84_0, ADS122X_CONFIG_0_REG, &ReadBackReg[0]);
                    response.progress = ReadBackReg[0];
                    //response.progress = HeadTempSensConfig[14].Reg0.Byte;
                break;
            case 0x8401:
                    HeadADCPT100_ReadReg(HEAD_PT100_ZONE_5_0X84_0, ADS122X_CONFIG_1_REG, &ReadBackReg[0]);
                    response.progress = ReadBackReg[0];
                    //response.progress = HeadTempSensConfig[14].Reg1.Byte;
                break;
            case 0x8402:
                    HeadADCPT100_ReadReg(HEAD_PT100_ZONE_5_0X84_0, ADS122X_CONFIG_2_REG, &ReadBackReg[0]);
                    response.progress = ReadBackReg[0];
                    //response.progress = HeadTempSensConfig[14].Reg2.Byte;
                break;
            case 0x8403:
                    HeadADCPT100_ReadReg(HEAD_PT100_ZONE_5_0X84_0, ADS122X_CONFIG_3_REG, &ReadBackReg[0]);
                    response.progress = ReadBackReg[0];
                    //response.progress = HeadTempSensConfig[14].Reg3.Byte;
                break;
            case 0x8600:
                    HeadADCPT100_ReadReg(HEAD_PT100_ZONE_7_0X86_0, ADS122X_CONFIG_0_REG, &ReadBackReg[0]);
                    response.progress = ReadBackReg[0];
                    //response.progress = HeadTempSensConfig[15].Reg0.Byte;
                break;
            case 0x8601:
                    HeadADCPT100_ReadReg(HEAD_PT100_ZONE_7_0X86_0, ADS122X_CONFIG_1_REG, &ReadBackReg[0]);
                    response.progress = ReadBackReg[0];
                    //response.progress = HeadTempSensConfig[15].Reg1.Byte;
                break;
            case 0x8602:
                    HeadADCPT100_ReadReg(HEAD_PT100_ZONE_7_0X86_0, ADS122X_CONFIG_2_REG, &ReadBackReg[0]);
                    response.progress = ReadBackReg[0];
                    //response.progress = HeadTempSensConfig[15].Reg2.Byte;
                break;
            case 0x8603:
                    HeadADCPT100_ReadReg(HEAD_PT100_ZONE_7_0X86_0, ADS122X_CONFIG_3_REG, &ReadBackReg[0]);
                    response.progress = ReadBackReg[0];
                    //response.progress = HeadTempSensConfig[15].Reg3.Byte;
                break;

            default:
                    if((request->delay >= HEAD_PT100_ZONE_1_0X80_0) && (request->delay <= HEAD_PT100_RESERVE_0X8E_1))
                    {
                        response.progress = TempSensorResponse[request->delay].PT100_ADC_Reading_Bits;
                    }
                break;
        }

        response.has_progress = true;
    }
    else
    if(request->amount == 0xb05)
    {
        response.progress = Test_Uart3(request->delay);
        response.has_progress = true;
    }
    else
    if(request->amount == 0xdace)//test_dancer_responce_RTFU
        //in order to use it unmark the define test_RTFU_dancer !!!!!!!!!!!
    {
        test_dancer_flag = true;

        if(request->delay == 0x01)
        {
            test_dancer_direction  = true;
        }
        else
        if(request->delay == 0x00)
        {
            test_dancer_direction  = false;
        }

        response.progress = 0xdace;
        response.has_progress = true;
    }
    else
    if(request->amount == 0xb10) //S.S Head Sensor board
        {
            if(request->delay == 0x01)
            {
                response.progress = HeadCard_ActivateHeadPressureArcBlowers();
            }
            else if(request->delay == 0x00)
            {
                response.progress = HeadCard_DeActivateHeadPressureArcBlowers();
            }
            response.has_progress = true;
        }

    else
        if(request->amount == 0x3EC)
        {
            if(request->delay == 0x01)
            {
                uint16_t Vm_mv = 0;

                Trigger_WHS_MAX11614_Read_allADC();

                get_vlev1(&Vm_mv);
                response.progress = Vm_mv;
                response.has_progress = true;
            }
        }
    else
       if(request->amount == 0x3EB) //whs valves
       {
           if (WHS_Type == WHS_TYPE_NEW)
           {
               if(request->delay == 0x0101)
               {
                   Trigger_SetWHSValveWatseCartridge(OPEN);
               }
               else
               if(request->delay == 0x0100)
               {
                   Trigger_SetWHSValveWatseCartridge(CLOSE);
               }
               else
               if(request->delay == 0x0201)
               {
                   Trigger_SetWHS_VOC_Valve(OPEN);
               }
               else
               if(request->delay == 0x0200)
               {
                   Trigger_SetWHS_VOC_Valve(CLOSE);
               }
               response.progress = 0;
               response.has_progress = false;
           }
       }
    else
       if(request->amount == 0x3EA) //whs pump
       {
           if (WHS_Type == WHS_TYPE_NEW)
           {
               if(request->delay == 0x01)
               {
                   Trigger_SetWHSPump(OPEN);
               }
               else
               if(request->delay == 0x00)
               {
                   Trigger_SetWHSPump(CLOSE);
               }
           }
           response.progress = 0;
           response.has_progress = false;
       }
    else
    if(request->amount == 0x3E9) // set TCA9555 u3 or u4
    {
        if (WHS_Type == WHS_TYPE_NEW)
        {
            if (request->delay & 0x8000)        // bit15 select the chip address
            {
                addr =  I2CExp2_ADDRESS;
            }
            else
            {
                addr =  I2CExp1_ADDRESS;
            }

            if  (request->delay & 0x4000)   // bit 14 select port 0 or 1
            {
                port = D_TCA9555_PORT_1;
            }
            else
            {
                port = D_TCA9555_PORT_0;
            }

            pin = ((request->delay & 0x0F00) >> 8);  // 8..11

            if (request->delay & 0x0001)
            {
                value = 1;
            }
            else
            {
                value = 0;
            }
            response.progress = Write_WHS_9555_io_value( addr,  port,  pin,  value);
            response.has_progress = true;
        }
    }
    else
        if(request->amount == 0x3E8) //&& (request->delay <= 0x0fff))// set WHS Blower speed 0x00-0xfff
        {
            if (WHS_Type == WHS_TYPE_NEW)
            {
                WHS_enable_control_loop( request->delay & 0x1000);//disable control loop: 0=disable 1= enable
                Trigger_SetWHSBlowerVoltage (request->delay & 0x0FFF);
                response.progress = 0;
                response.has_progress = false;
            }
        }
    else
        if (request->amount == 0x3E7) // set WHS Blower speed by Q value
        {
             if (WHS_Type == WHS_TYPE_NEW)
             {
                 WHS_Set_SetPoint_Q_value((double) request->delay);
                 response.progress = 0;
                 response.has_progress = false;
             }
        }
    else
        if (request->amount == 0x3E6) // get WHS Blower speed by Q value
        {
             if (WHS_Type == WHS_TYPE_NEW)
             {
                 response.progress = WHS_Get_Volt_Blower_Control();
                 //response.progress = 0;
                 response.has_progress = true;
             }
        }
    //   WHS_Get_Volt_Blower_Control
    else
        if(request->amount == 0x3EA)
        {
            uint16_t tempu16 = 0;
            double temp_double = 0.0;
            uint8_t display_byte = 0;
            uint16_t A2D_data = 0;

            if (WHS_Type == WHS_TYPE_NEW)
            {
                /*display_byte = ((request->delay & 0x3000)>>12);
                switch (display_byte)
                {
                case 0:
                    //stubManager.Run<ProgressResponse>("ProgressRequest" ,0x3EA, 0x0000); //
                    SetLeftDisplayView (HeadAVERAGE);
                    SetWriteDisplayView(DrierAVERAGE);
                    SetDisplayView (AVERAGE);
                    break;
                case 1:
                    //stubManager.Run<ProgressResponse>("ProgressRequest" ,0x3EA, 0x1000); //
                    SetLeftDisplayView (HeadAVERAGE);
                    SetWriteDisplayView(HeadCURRENT);
                    break;
                case 2:
                    //stubManager.Run<ProgressResponse>("ProgressRequest" ,0x3EA, 0x2000); //
                    SetLeftDisplayView (DrierAVERAGE);
                    SetWriteDisplayView(DrierCURRENT);
                    break;
                case 3:
                    //stubManager.Run<ProgressResponse>("ProgressRequest" ,0x3EA, 0x3000); //
                    SetLeftDisplayView (HeadCURRENT);
                    SetWriteDisplayView(DrierCURRENT);
                    SetDisplayView (CURRENT);
                    break;
                }*/

                A2D_data = (request->delay & 0x0FFF);
                switch(A2D_data )// get A2D
                {
                    case 0:
                        get_orf_1(&tempu16);
                        break;
                    case 1:
                        get_orf_2(&tempu16);
                        break;
                    case 2:
                        get_orf_3(&tempu16);
                        break;
                    case 3:
                        get_vlev1(&tempu16);
                        break;
                    case 4:
                        get_vlev2(&tempu16);
                        break;
                    case 5:
                        get_gas_out(&tempu16);
                        break;
                    case 6:
                        get_cur_fan(&tempu16);
                        break;
                    case 7:
                        get_cur_vlv1(&tempu16);
                        break;
                    case 8:
                        tempu16 = 0;  //get_cur_vlv2(&tempu16);
                        break;
                    case 10:
                        temp_double = get_Q(HEAD_FLOW_METER);
                        break;
                    case 12:
                        temp_double = get_Q(DRIER_FLOW_METER);
                        break;
                    /*case 20:
                        //temp_double = get_average_Q(HEAD_FLOW_METER); //HEAD
                        break;
                    case 22:
                        //temp_double = get_average_Q(DRIER_FLOW_METER); //Drier
                        break;

                    case 11:
                        //get_orf_2(&tempu16);
                        break;
                    case 13:
                        //get_vlev1(&tempu16);
                        break;
                    case 14:
                        //get_vlev2(&tempu16);
                        break;
                    case 15:
                        //get_gas_out(&tempu16);
                        break;
                    case 16:
                        //get_cur_fan(&tempu16);
                        break;
                    case 17:
                        //get_cur_vlv1(&tempu16);
                        break;
                    case 18:
                        //tempu16 = 0;  //get_cur_vlv2(&tempu16);
                        break;*/
                    default :
                        tempu16 = 0x500;  //get_cur_vlv2(&tempu16);
                        break;
                }
           }
       if ((request->delay)<10)
       {
           response.progress = (double)tempu16;
       }
       else
       {
           response.progress = temp_double;
       }
       response.has_progress = true;
    }
    else //
    if(request->amount == 0x3ED)
    {
        uint16_t tempu16 = 0;
        if (WHS_Type == WHS_TYPE_NEW)
        {
            if (request->delay <= 0x03FF)
            {
                Trigger_WHS_Set_RDAC(request->delay);  // 0 -> 0x03FF
                get_gas_out(&tempu16);
            }
            else if (request->delay == 0x0FFF)
            {
                Trigger_WHS_set_Rheostat_to_CLEAN_AIR();

                //Search_Rheostat_Value_for_Air_clibration();
                get_gas_out(&tempu16);
            }
            else if (request->delay == 0x04FF)
                get_gas_out(&tempu16);
        }
        response.progress = (double)tempu16;
        response.has_progress = true;
    }
    else
    if((request->amount == 0xDE) && (request->delay < 8) && (request->delay >= 0)) // read dispenser type + LS status
    {
        response.progress = ((Dispenser_struct[request->delay].Type) << 8) + Dispenser_struct[request->delay].Status;
        response.has_progress = true;
    }
    else
    if(request->amount == 0xAD) //undef AUTO_HOME_DISPENSERS
    {
        if ((request->delay >=AutoHoming_off )&&(request->delay<=AutoHoming_JobEnd_PowerOn_off ))
            IDS_Dispenser_SetAutoHoming_Config(request->delay);
        response.progress = 01;
        response.has_progress = true;
    }
    else
    if(request->amount == 0xAD1) //Set_Check_Pressure_Bypass
    {
        LOG_ERROR((request->delay)?1:0,"Set_Check_Pressure_Bypass");
        response.progress = Set_Check_Pressure_Bypass(request->delay);
        response.has_progress = true;
    }
    else
    if(request->amount == 0xAD2) //Set_Thread_Rockers_Bypass
    {
        LOG_ERROR((request->delay)?1:0,"Set_Thread_Rockers_Bypass");
        response.progress = Set_Thread_Rockers_Bypass(request->delay);
        response.has_progress = true;
    }
    else
    if(request->amount == 0xAD3) //Set_Auto_Shutdown_Bypass
    {
        LOG_ERROR((request->delay)?1:0,"Set_Auto_Shutdown_Bypass");
        response.progress = Set_Auto_Shutdown_Bypass(request->delay);
        response.has_progress = true;
    }
    else
    if(request->amount == 0xAD4) //Set_Auto_Idle_Bypass
    {
        LOG_ERROR((request->delay)?1:0,"Set_Auto_Idle_Bypass");
        response.progress = Set_Auto_Idle_Bypass(request->delay);
        response.has_progress = true;
    }
    else
    if((request->amount == 0x01) && ((request->delay &0x010000) == 0x010000)) //change mode powerset01
    {
        response.progress = Power_Step_01_Mode(((request->delay &0x00FF00)>>8), request->delay &0x0000FF);
        response.has_progress = true;
    }
    else
    if((request->amount == 0xAB) && (request->delay == 0xAB)) //Get pressure with flow (orifice flow meter)
    {
        response.progress = Calculate_Pitot_Pressure(true);
        response.has_progress = true;

    }
    else
        if((request->amount == 0xAB) && (request->delay == 0x0)) //measured sensor voltage without flow (orifice flow meter)
    {
        response.progress = Calculate_Pitot_Pressure(false);
        response.has_progress = true;

    }
    else
    if((request->amount == 0xAC) && (request->delay == 0xAC)) //VAC
    {
            response.progress = ReadVAC();
            response.has_progress = true;

    }
    else
        if(request->amount == 0x0EAD)  //Head Card I/O
        {
            uint8_t Read_Buf[1] = {0};
            uint8_t Write_Buf[2] = {0,0};
            uint8_t Script_Slave_Add = request -> delay >> 16;//Slave address 0x40 / 0x42 / 0x44 / 0x46
            Write_Buf[0] = (request -> delay & 0x00FF00) >> 8;//read/write low/high
            /*
            ------------------
            | Byte | WR | RD |
            ------------------
            | Low  | 02 | 00 |
            | High | 03 | 01 |
            ------------------
            */
            Write_Buf[1] = request -> delay & 0x0000FF;//data to write

            response.has_progress = false;

            Select_Main_Head_Mux_Channel();

            if(Write_Buf[0] == 0)//Read
            {
                //Head_Read_IO_Reg(Script_Slave_Add, LOW);

                delayms(1);
                if(Script_Slave_Add == 0x40)
                {
                    Read_Buf[0] = Head_I2C_EXP1_0x40.uchar[0];
                    response.progress = Read_Buf[0];
                    response.has_progress = true;
                }
                else
                if(Script_Slave_Add == 0x42)
                {
                    Read_Buf[0] = Head_I2C_EXP2_0x42.uchar[0];
                    response.progress = Read_Buf[0];
                    response.has_progress = true;
                }
                else
                if(Script_Slave_Add == 0x44)
                {
                    Read_Buf[0] = Head_I2C_EXP3_0x44.uchar[0];
                    response.progress = Read_Buf[0];
                    response.has_progress = true;
                }
                else
                if(Script_Slave_Add == 0x46)
                {
                    Read_Buf[0] = Head_I2C_EXP4_0x46.uchar[0];
                    response.progress = Read_Buf[0];
                    response.has_progress = true;
                }
            }
            else

            if(Write_Buf[0] == 1)//Read
            {
                //Head_Read_IO_Reg(Script_Slave_Add, HIGH);

                delayms(1);
                if(Script_Slave_Add == 0x40)
                {
                    Read_Buf[0] = Head_I2C_EXP1_0x40.uchar[1];
                    response.progress = Read_Buf[0];
                    response.has_progress = true;
                }
                else
                if(Script_Slave_Add == 0x42)
                {
                    Read_Buf[0] = Head_I2C_EXP2_0x42.uchar[1];
                    response.progress = Read_Buf[0];
                    response.has_progress = true;
                }
                else
                if(Script_Slave_Add == 0x44)
                {
                    Read_Buf[0] = Head_I2C_EXP3_0x44.uchar[1];
                    response.progress = Read_Buf[0];
                    response.has_progress = true;
                }
                else
                if(Script_Slave_Add == 0x46)//LS
                {
                    Read_Buf[0] = Head_I2C_EXP4_0x46.uchar[1];
                    response.progress = Read_Buf[0];
                    response.has_progress = true;
                }
            }
            else
            /*
            if(Write_Buf[0] == 2)//write
            {
                if(Script_Slave_Add == 0x40)
                {
                    Head_I2C_EXP1_0x40.uchar[0] = Write_Buf[1];
                }
                else
                if(Script_Slave_Add == 0x42)
                {
                    Head_I2C_EXP2_0x42.uchar[0] = Write_Buf[1];
                }
                else
                if(Script_Slave_Add == 0x46)
                {
                    Head_I2C_EXP4_0x46.uchar[0] = (Write_Buf[1] & 0x80);
                }

                //Head_Write_IO_Reg(Script_Slave_Add, LOW);
            }
            if(Write_Buf[0] == 3)//write
            {
                if(Script_Slave_Add == 0x40)
                {
                    Head_I2C_EXP1_0x40.uchar[1] = Write_Buf[1];
                }
                else
                if(Script_Slave_Add == 0x42)
                {
                    //Head_I2C_EXP2_0x42.uchar[1] = Write_Buf[1];
                    Head_I2C_EXP2_0x42.bits.OUTPUT_MAG_DIR = (Write_Buf[1] & 0x01);//control only the magnet
                }
                else
                if(Script_Slave_Add == 0x46)
                {
                    Head_I2C_EXP3_0x44.uchar[1] = (Write_Buf[1] & 0x0C);
                }
                //Head_Write_IO_Reg(Script_Slave_Add, HIGH);
            }
            */
                if(Write_Buf[0] >=0xF0) // write
                {
                    // write , Write_Buf[0] bit number 0..15 , Write_Buf[1] 0 or 1
                    Write_Buf[1] = Write_Buf[1] & 0x01;

                    Write_Buf[0] &=0x0f;

                    if(Script_Slave_Add == 0x40)
                    {
                        if(Write_Buf[1] == 0x01)
                            Head_I2C_EXP1_0x40.ushort |= (0x01 << Write_Buf[0]);
                        else if(Write_Buf[1] == 0x00)
                            Head_I2C_EXP1_0x40.ushort &= ~(0x01 << Write_Buf[0]);
                    }
                    else
                    if(Script_Slave_Add == 0x42)
                    {
                        if(Write_Buf[1] == 0x01)
                            Head_I2C_EXP2_0x42.ushort |= (0x01 << Write_Buf[0]);
                        else if(Write_Buf[1] == 0x00)
                            Head_I2C_EXP2_0x42.ushort &= ~(0x01 << Write_Buf[0]);
                    }
                    else
                    if(Script_Slave_Add == 0x46)
                    {
                        if(Write_Buf[1] == 0x01)
                            Head_I2C_EXP4_0x46.ushort |= (0x01 << Write_Buf[0]);
                        else if(Write_Buf[1] == 0x00)
                            Head_I2C_EXP4_0x46.ushort &= ~(0x01 << Write_Buf[0]);
                    }
                }
        }
        else
    if(request->amount == 0xFEAD)  //functions Head Card I/O
    {
        Select_Main_Head_Mux_Channel();

        if((request -> delay & 0xFFF000) == 0xCAF000)//Actuator
        {
            if((request -> delay & 0x00000F) >1)
            {
                if((request -> delay & 0xFFFFFF) == 0xCAF002)//ACTUATOR-IN down without delay and without stop the actuator
                {
                    Trigger_Head_Actuators_Stub(ACTIN, true, false);
                }
                else
                if((request -> delay & 0xFFFFFF) == 0xCAF003)//ACTUATOR-IN up without delay and without stop the actuator
                {
                    Trigger_Head_Actuators_Stub(ACTIN, true, true);
                }
                else
                if((request -> delay & 0xFFFFFF) == 0xCAF008)//Stop  ACTUATOR-IN
                {
                    Trigger_Head_Actuators_Stub(ACTIN, false, true);
                }
                else
                if((request -> delay & 0xFFFFFF) == 0xCAF102)//ACTUATOR-OUT  down without delay and without stop the actuator
                {
                    Trigger_Head_Actuators_Stub(ACTOT, true, false);
                }
                else
                if((request -> delay & 0xFFFFFF) == 0xCAF103)//ACTUATOR-OUT  up without delay and without stop the actuator
                {
                    Trigger_Head_Actuators_Stub(ACTOT, true, true);
                }
                else
                if((request -> delay & 0xFFFFFF) == 0xCAF108)//Stop  ACTUATOR-OUT
                {
                    Trigger_Head_Actuators_Stub(ACTOT, false, true);
                }
            }
            else
            {
                //HeadCard_Actuators_Control((ACTUATORS)(((request -> delay) & 0x100)>>8), /*(bool)((request -> delay & 0x10)>>4), */(bool)((request -> delay & 0x01)));//Actuators: ID, power, Direction
                Trigger_Head_Actuators_Control((ACTUATORS)(((request -> delay) & 0x100)>>8), (bool)((request -> delay & 0x10)>>4), (bool)((request -> delay & 0x01)));//Actuators: ID, power, Direction
                //response.progress = HeadCard_Actuators_Status((ACTUATORS)((request -> delay) & 0x100)>>8);
            }
            response.has_progress = true;
        }
        else
        if((request -> delay & 0xFF0000) == 0xCA0000)//control all heaters
        {
            if(request -> delay & 0x01)
            {
                Disconnect_Mixer_and_12_Heaters_Latch();
                HeadCard_Control_Heaters((request -> delay & 0xFF00)>>8, TRUE);
                Connect_Mixer_and_12_Heaters_Latch();
            }
            else
                HeadCard_Control_Heaters((request -> delay & 0xFF00)>>8, FALSE);
        }
        else
        if(request -> delay == 0x0)//return head type
        {
            response.progress = Head_Type;
            response.has_progress = true;
        }

    }
    else
    if((request->amount == 0xFAC0) /*&& (request->delay == 0xFAC)*/) //Head Fan control
    {
        //Head_Fan_PWM_Command[0] = (request->delay & 0xFF) ;
        //Test_Head_fan_Click();

        Trigger_Head_Fan_Control(HEAD_FAN_RIGHT, request->delay & 0xFF);
        Task_sleep(2000);

        //response.progress = Fan_Click_Info.Product_ID;
        response.progress = Head_Fan_Tach[0];
        response.has_progress = true;

    }
    else
    if((request->amount == 0xFAC1) /*&& (request->delay == 0xFAC)*/) //Head Fan control
    {
        Trigger_Head_Fan_Control(HEAD_FAN_LEFT, request->delay & 0xFF);
        Task_sleep(2000);
        response.progress = Head_Fan_Tach[1];
        response.has_progress = true;
    }
    else
    if ((request->amount & 0x0000FFF0) == 0xFAC0) //WHS Fan control
    {
        uint16_t fan_tacho = 0;

        if (WHS_Type == WHS_TYPE_NEW)
        {
            Trigger_SetWHSFanSpeed(((request->amount & 0x0000000F)-1) , request->delay & 0x000000FF);
            Task_sleep(2000);
            fan_tacho = WHS_Get_fan_tach( (request->amount & 0x0000000F)-1);
        }
        response.progress = fan_tacho;
        response.has_progress = true;
    }
    else
    if((request->amount == 0x0A) && ((request->delay >= 0) && (request->delay < 8))) //read the midtank calibration
    {
        response.progress = Initial_Offset_A[request->delay];
        response.has_progress = true;
    }
    else
    if((request->amount == 0xB) && ((request->delay >= 0) && (request->delay < 8)))  //read the midtank calibration
    {
        response.progress = Slope_B[request->delay];
        response.has_progress = true;
    }
    else
    if((request->amount == 0x5C4E) && (request->delay == 0x5C4E)) //Screw Home Pos dir
    {
        test_Home_Pos();
    }
    else
    if((request->amount == 0x100) && (request->delay == 0x100)) //head card PT100
    {
        Test_HeadCard_PT100(TEMP_SENSE_ANALOG_DYEINGH_TEMP1);
        //response.progress = (double)Test_Read_Buf[0];
        response.progress = (double)Data_ADC_Head;
        response.has_progress = true;
    }
    else
    if((request->amount == 0x0D) && (request->delay == 0xEE)) //Dispenser EEprom
    {
        test_disp_eeprom(0x01,0xA0);
        response.progress = OK;
        response.has_progress = true;
    }
    else
    if((request->amount == 0xCF) && (request->delay == 0xCF)) //Create File System on the Drive
    {
#ifdef WATCHDOG
        ROM_WatchdogResetDisable(WATCHDOG0_BASE);
        uint32_t timeout = 0xFFFFFFFFU;
        ROM_WatchdogReloadSet(WATCHDOG0_BASE, timeout);
#endif
        FRESULT iFResult = Init_Flash_File_System(true);
        if(iFResult != FR_OK)
        {
            LOG_ERROR (iFResult, "Error during init Flash File System");
            assert(iFResult);
        }
#ifdef WATCHDOG
        ROM_WatchdogResetEnable(WATCHDOG0_BASE);
        timeout = 120000000*3;
        ROM_WatchdogReloadSet(WATCHDOG0_BASE, timeout);
#endif
    }
    else
    if((request->amount == 0x0C) && (request->delay == 0x0C)) //Get Gas Sensor
    {
        response.progress = (double)Calculate_Gas_Power_Consumption();
        response.has_progress = true;

    }
    else
    if((request->amount == 0xDD) && (request->delay == 0xDD)) //Read Input Voltage
    {
        LOG_ERROR(request->delay,"CheckAcInputVoltage");
       CheckAcInputVoltage();

       response.progress = (double)Input_Voltage;
       response.has_progress = true;
    }
    else
    if((request->amount == 0x0CE) && (request->delay == 0x0CE)) //Get Gas Sensor
    {
        LOG_ERROR(request->delay,"FlashInit");
        FlashInit();
        response.progress = (double)OK;
        response.has_progress = true;
        RestartNeeded = true;
    }
    else
    if((request->amount == 0x0CD) && (request->delay == 0x0CD)) //Get Gas Sensor
    {
        LOG_ERROR(request->delay,"Load embedded parameters from file and restart");
        LoadConfigurationParamsFromFile(true);
        response.progress = (double)OK;
        response.has_progress = true;

    }
    else
    if(request->amount == 0x0CC)  //Cartridge Validation Response Demo
    {
        LOG_ERROR(request->delay,"ResponseDemo");
		ResponseDemo(request->delay);
        response.progress = (double)OK;
        response.has_progress = true;
    }
    else
    if(request->amount == 0xE0)  //fast refresh for pressure
    {
        LOG_ERROR(request->delay,"setRapidPressureRead");
        setRapidPressureRead(request->delay);
        response.progress = (double)OK;
        response.has_progress = true;
    }
    else
    if(request->amount == 0xE1)  //fast refresh for pressure
    {
        LOG_ERROR(request->delay,"Starting Dispenser PID");
        IDS_Start_Pid_Testing(request->delay);
        response.progress = (double)OK;
        response.has_progress = true;
    }
    else
    if(request->amount == 0xE2)  //fast refresh for pressure
    {
        LOG_ERROR(request->delay,"Stoping Dispenser PID");
        IDS_Stop_Pid_Testing(request->delay);
        response.progress = (double)OK;
        response.has_progress = true;
    }
    else
    if(request->amount == 0xE3)  //fast refresh for pressure
    {
        Report("Set WFCF Value ",__FILE__,__LINE__,request->delay,RpWarning,(int)Get_WFCF_Time(),0);
        IDS_Dispenser_SetPreSegmentWFCFValues((double) request->delay, Get_WFCF_Time());
        response.progress = (double)OK;
        response.has_progress = true;
    }
    else
    if(request->amount == 0xE4)  //fast refresh for pressure
    {
        Report("Set WFCF build to waste Time Value ",__FILE__,__LINE__,request->delay,RpWarning,(int)Get_WFCF(),0);
        IDS_Dispenser_SetPreSegmentWFCFValues(Get_WFCF(),(double) request->delay);
        response.progress = (double)OK;
        response.has_progress = true;
    }
    else
    if(request->amount == 0xE5)  //fast refresh for pressure
    {
        if (request->delay<=1)
        {
            Report("Set special dispensers ",__FILE__,__LINE__,request->delay,RpWarning,Special_Dispensers,0);
            Special_Dispensers = request->delay;
        }
        response.progress = (double)OK;
        response.has_progress = true;
    }
    else
    if(request->amount == 0xE6)  //fast refresh for pressure
    {
        Report("HeaterSafetyTestSetLimits ",__FILE__,__LINE__,request->delay,RpWarning,0,0);
        HeaterSafetyTestSetLimits(request->delay);
        response.progress = (double)OK;
        response.has_progress = true;
    }

    else
    if(request->amount == 0xB1)  //fast refresh for pressure
    {
        LOG_ERROR(request->delay,"Set loading arm center");
        Read_Dryer_ENC_Position();
        Task_sleep(500);
        Read_Dryer_ENC_Position();
        Task_sleep(500);

        response.progress = (double)MCU_E2PromProgram(EEPROM_STORAGE_DRYER_CENTER,Read_Dryer_ENC_Position(0,0));
        response.has_progress = true;
    }
    else
    if(request->amount == 0xB2)  //Set loading arm cycles
    {
        LOG_ERROR(request->delay,"Set loading arm cycles");

        response.progress = (double)MCU_E2PromProgram(EEPROM_STORAGE_DRYER_CYCLES,request->delay);
        response.has_progress = true;
    }

    else
    if(request->amount == 0xB3)  //fast refresh for pressure
    {
        LOG_ERROR(request->amount,"keep alive test");
        response.progress = keepalivetest;
        response.has_progress = true;

    }
    else
    if(request->amount == 0xB4)  //IDS_Dispenser_Content_Init
    {
        LOG_ERROR(request->amount,"IDS_Dispenser_Content_Init");
        IDS_Dispenser_Content_Init();
        response.progress = keepalivetest;
        response.has_progress = true;

    }
    else
    if(request->amount == 0xB5)  //fast refresh for pressure
    {
        if (request->delay<=100)
        {
            LOG_ERROR(request->delay,"set stub_heating_limit");
            stub_heating_limit = request->delay;
        }
        response.progress = request->delay;
        response.has_progress = true;

    }
#ifdef VAC_TEST
    else
    if(request->amount == 0xB6)  //fast refresh for pressure
    {
        LOG_ERROR(request->delay,"set vac read test");
        VAC_Test = (double)request->delay;
        response.progress = request->delay;
        response.has_progress = true;

    }
#endif
    else
    if(request->amount == 0xB7)  //fast refresh for pressure
    {
        specialHeaterState = request->delay?true:false;
        LOG_ERROR(specialHeaterState,"set specialHeaterState");
        response.progress = specialHeaterState;
        response.has_progress = true;

    }
    else
    if(request->amount == 0xC3)  //suspend I2C task
    {
        if (request->delay == 0)
        {
            LOG_ERROR(request->delay,"Suspend I2C");
            PowerOffHeatersOff();
            Task_sleep(1000);
            Task_setPri (I2C_Task_Handle,-1);
        }
        else
        {
            LOG_ERROR(request->delay,"Resume");
            Task_setPri (I2C_Task_Handle,8);
        }
        response.progress = request->delay;
        response.has_progress = true;

    }
    else     
	if((request->amount == 0xDF) && (request->delay == 0xDF)) //Power off
    {
        PowerOffInit();
    }
    else
    if(request->amount == 0xF1)
    {
        LOG_ERROR(request->delay,"NumberOfRotationPerPassage");
        NumberOfRotationPerPassage = (float)(request->delay)/1000;
    }
    else
    {
        response.has_progress = true;
        int i = 0;
        for (i = 0; i < request->amount; i++)
        {
            response.progress = i;
            responseContainer = createContainer(MESSAGE_TYPE__ProgressResponse, requestContainer->token, false, &response, &progress_response__pack, &progress_response__get_packed_size);
            uint8_t* container_buffer = malloc(message_container__get_packed_size(&responseContainer));
            size_t container_size = message_container__pack(&responseContainer, container_buffer);
            free(responseContainer.data.data);
            SendChars((char*)container_buffer, container_size);
            //free(container_buffer);


            int co = 0;
            for (co = 0; co < request->delay; co++)
            {
                __delay_cycles(1000000);
            }
        }
    }
    responseContainer = createContainer(MESSAGE_TYPE__ProgressResponse, requestContainer->token, true, &response, &progress_response__pack, &progress_response__get_packed_size);
    uint8_t* container_buffer = malloc(message_container__get_packed_size(&responseContainer));
    size_t container_size = message_container__pack(&responseContainer, container_buffer);
    free(responseContainer.data.data);
    //writeLine("Progress Completed!");
    SendChars((char*)container_buffer, container_size);
    //free(container_buffer);
    if (RestartNeeded == true)
    {
        LOG_ERROR(255,"Update successful, Rebooting in 5 seconds");
        Task_sleep (eOneSecond*5);
        Power_Reset();
        RestartNeeded = false;
    }

    return;

}