#include "Can_App.h"
#include "Components.h"
#include "Application.h"

uint16_t CAN_TX_Count = 0;
uint16_t AliveCountTimer = 0;
extern uint8_t Tpms_TX_Flag;
void CAN_TX_Count_Init(void)
{
    CAN_TX_Count = 0;
    AliveCountTimer = 0;
}
void Can_Set_Buff_220(canlib_uint8_t CopyData[])
{
    CANMsg220Union *p220;
    uint8_t i = 0;

    p220 = (CANMsg220Union *)CopyData;
    if ( p220 != ( void * )0 )
    {
        for ( i = 0u; i < 8u; i++ )
        {
            p220->Msg [ i ] = 0x0u;
        }

        p220 -> Sig.TCS_TX = Get_Dis_Tcs_Val();
        p220 -> Sig.AliveCounter = AliveCountTimer;
        p220 -> Sig.CheckSum = (Get_Dis_Tcs_Val() == 1) ? 8 : 0;
    }

    
    
}
void Can_Set_Buff_6EE(canlib_uint8_t CopyData[])
{
    CANMsg6EEUnion *p6EE;
    uint8_t i = 0;
    uint16_t Vspeed_tx = 0;
    uint32_t ODO_tx = Data_ODO_Read();    
    Vspeed_tx = Get_DispVechileSpeed_TX()/10;
    p6EE = (CANMsg6EEUnion *)CopyData;
    
    if ( p6EE != ( void * )0 )
    {
        for ( i = 0u; i < 8u; i++ )
        {
            p6EE->Msg [ i ] = 0x0u;
        }
        p6EE -> Sig.ODO_TX_H        = (ODO_tx >> 16) & 0xFF ;
        p6EE -> Sig.ODO_TX_M        = (ODO_tx >> 8) & 0xFF ;
        p6EE -> Sig.ODO_TX_L        = ODO_tx & 0xFF ;
        if(Get_Fuel_RES() > 255)
        {
            p6EE -> Sig.Fuel_Res_TX  = 0xFF ; 
        }
        else
        {
            p6EE -> Sig.Fuel_Res_TX  = Get_Fuel_RES() ; 
        }
       
    } 
    //p6EE -> Sig.Vsppe_H3_TX     = (Vspeed_tx >> 8) & 0x7u ;
    //p6EE -> Sig.Vsppe_L8_TX     = Vspeed_tx & 0xFF ;
    
   // p6EE -> Sig.Uint_TX         = Get_Dis_KM_Unit() ;
   // p6EE -> Sig.Coolant_Seg_TX  = GET_DataCoolantTempSegDisp() ;
    //if (GET_DataCollantTempWarnflg() == 2)
    //{
    //    p6EE -> Sig.Coolant_Warn_TX = 1;
    //}
    //else
    //{
    //    p6EE -> Sig.Coolant_Warn_TX = 0;
    //}
    //p6EE -> Sig.Fuel_Seg_TX  = Get_CurFuelSetp() ;
    
    
}
void Can_Set_Buff_6EF(canlib_uint8_t CopyData[])
{
    CANMsg6EFUnion *p6EF;
    uint8_t i = 0;
    uint16_t Espeed_tx = 0;
    uint16_t TripA_tx = 0;
    Espeed_tx = Get_ActualEngineSpeed()/100;
    TripA_tx  = Data_Read_Trip(EM_TRIP_A);
    p6EF = (CANMsg6EFUnion *)CopyData;
    if ( p6EF != ( void * )0 )
    {
        for ( i = 0u; i < 8u; i++ )
        {
            p6EF->Msg [ i ] = 0x0u;
        }
        p6EF -> Sig.TripA_H    = (TripA_tx >> 8) & 0xFF;
        p6EF -> Sig.TripA_L    = TripA_tx  & 0xFF;
    }
    //p6EF -> Sig.Espeed_TX  = Espeed_tx;
    
    //p6EF -> Sig.Coolant_TX = GET_DataCoolantTempValueDisp() + 40;
}
void Can_Set_Buff_450(canlib_uint8_t CopyData[])
{
    CANMsg450Union *p450;
    uint8_t i = 0;
    uint16_t u16FrontTpms = 0;
    uint16_t u16RearTpms = 0;

    p450 = (CANMsg450Union *)CopyData;
    if ( p450 != ( void * )0 )
    {
        for ( i = 0u; i < 8u; i++ )
        {
            p450->Msg [ i ] = 0x0u;
        }
        if(Get_Front_TPMS_Sig_Vaild() == 0\
            || Get_TPMS_Front_Learn() != 2 
            || CAN_MSG_Status(&CAN_CH0_CanMsgOp, CAN_CH0_ID_CAN_0x373_Msg_Count) == CAN_SIG_LOST\
            || Get_Front_TPMS_ID_Vaild() == 0)
        {
            p450 -> Sig.Front_Pressure_TX_H  = 0;
            p450 -> Sig.Front_Pressure_TX_L  = 0;
        }
        else
        {
            if((Get_Front_TPMS_TX() + 146) <= 1000U)
            {
                u16FrontTpms = (Get_Front_TPMS_TX() + 146);
            }
            else
            {
                u16FrontTpms = 1000U;
            }
            p450 -> Sig.Front_Pressure_TX_H  = ( u16FrontTpms >> 8) & 0xFF;
            p450 -> Sig.Front_Pressure_TX_L  = ( u16FrontTpms) & 0xFF;
        }
        if(Get_Rear_TPMS_Sig_Vaild() == 0\
            || Get_TPMS_Rear_Learn() != 2 
            || CAN_MSG_Status(&CAN_CH0_CanMsgOp, CAN_CH0_ID_CAN_0x373_Msg_Count) == CAN_SIG_LOST\
            || Get_Rear_TPMS_ID_Vaild() == 0)
        {
            p450 -> Sig.Rear_Pressure_TX_H   = 0;
            p450 -> Sig.Rear_Pressure_TX_L   = 0;
        }
        else
        {
            if((Get_Rear_TPMS_TX() + 146) <= 1000U)
            {
                u16RearTpms = (Get_Rear_TPMS_TX() + 146);
            }
            else
            {
                u16RearTpms = 1000U;
            }
            p450 -> Sig.Rear_Pressure_TX_H   = (u16RearTpms >> 8) & 0xFF;
            p450 -> Sig.Rear_Pressure_TX_L   = (u16RearTpms) & 0xFF;
        }
        
    }
    
}
//uint8_t Can_580Send_flag = 0;
void Can_Set_Buff_580(canlib_uint8_t CopyData[])
{
    CANMsg580Union *p580;
    uint8_t i = 0;

    p580 = (CANMsg580Union *)CopyData;
    if ( p580 != ( void * )0 )
    {
        for ( i = 0u; i < 8u; i++ )
        {
            p580->Msg [ i ] = 0x0u;
        }

        if(Get_Tpms_TX_Flag() == 1)
        {
            //Can_580Send_flag = 1;
            //if(CAN_TX_Count++ > 2)
            //{
            //    Tpms_TX_Flag = 0;
            //    CAN_TX_Count = 0;
            //    //Can_580Send_flag = 0;
            //}
            p580 -> Sig.TPMS_LEARN_CND_BYTE0 = 0x31;
            p580 -> Sig.TPMS_LEARN_CND_BYTE1 = 0x01;
            p580 -> Sig.TPMS_LEARN_CND_BYTE2 = 0x59;
            p580 -> Sig.TPMS_LEARN_CND_BYTE3 = 0x08;
            p580 -> Sig.TPMS_LEARN_CND_BYTE4 = 0x00;
            //if(Can_580Send_flag == 0)
            //{
            //    Can_580Send_flag = 1;
            //    CAN_TX_Count++;
            //}
        }
        else if(Get_Tpms_TX_Flag() == 2)
        {
            //Can_580Send_flag = 1;
            //if(CAN_TX_Count++ > 2)
            //{
            //    Tpms_TX_Flag = 0;
            //    CAN_TX_Count = 0;
            //    //Can_580Send_flag = 0;
            //}
            p580 -> Sig.TPMS_LEARN_CND_BYTE0 = 0x31;
            p580 -> Sig.TPMS_LEARN_CND_BYTE1 = 0x01;
            p580 -> Sig.TPMS_LEARN_CND_BYTE2 = 0x59;
            p580 -> Sig.TPMS_LEARN_CND_BYTE3 = 0x08;
            p580 -> Sig.TPMS_LEARN_CND_BYTE4 = 0x01;
            //if(Can_580Send_flag == 0)
            //{
            //    Can_580Send_flag = 1;
            //    CAN_TX_Count++;
            //}
        }
        else
        {
            //Can_580Send_flag = 0;
            //CAN_TX_Count = 0;
            //p580 -> Sig.TPMS_LEARN_CND_BYTE0 = 0x0;
            //p580 -> Sig.TPMS_LEARN_CND_BYTE1 = 0x0;
            //p580 -> Sig.TPMS_LEARN_CND_BYTE2 = 0x0;
            //p580 -> Sig.TPMS_LEARN_CND_BYTE3 = 0x0;
            //p580 -> Sig.TPMS_LEARN_CND_BYTE4 = 0x02;
        }
    }
    

}