Subversion Repositories HomeAutomation

Rev

Rev 1586 | Blame | Compare with Previous | Last modification | View Log | SVN | RSS feed

  1. #include <math.h>
  2. #include "sns_NTC.h"
  3.  
  4. uint8_t sns_NTC_ReportInterval = (uint8_t)sns_NTC_SEND_PERIOD;
  5.  
  6. void sns_NTC_Init(void)
  7. {
  8.     ADC_Init();
  9.     Timer_SetTimeout(sns_NTC_TIMER, sns_NTC_ReportInterval*1000 , TimerTypeFreeRunning, 0);
  10.     Timer_SetTimeout(sns_NTC_SAMPLE_TIMER, sns_NTC_SAMPLE_PERIOD , TimerTypeFreeRunning, 0);
  11. }
  12.  
  13. void sns_NTC_Process(void)
  14. {
  15.     static uint32_t ad_filter;
  16.  
  17.     if (Timer_Expired(sns_NTC_SAMPLE_TIMER)) {
  18.         uint32_t x = ADC_Get(sns_NTC_AD_CH);
  19.         ad_filter += x - ad_filter / sns_NTC_FILTER_LEN;
  20.     }
  21.  
  22.     if (Timer_Expired(sns_NTC_TIMER)) {
  23.         //T=B/{ln{R/R_0}+B/T_0}
  24.         const float B = (float)sns_NTC_B;
  25.         const float B_div_T_0 = (float)sns_NTC_B / ((float)sns_NTC_T_0 + 273.15f);
  26.         const float R_0 = (float)sns_NTC_R_0;
  27.         float R;
  28.         float T;
  29.         R = R_0 * ad_filter / (1024.0f * sns_NTC_FILTER_LEN - ad_filter);
  30.         T = B / (log(R / R_0) + B_div_T_0);
  31.         int16_t T_10_6 = (int16_t)((T - 273.15f) * 64.0f);
  32.  
  33.         StdCan_Msg_t txMsg;
  34.         StdCan_Set_class(txMsg.Header, CAN_MODULE_CLASS_SNS);
  35.         StdCan_Set_direction(txMsg.Header, DIRECTIONFLAG_FROM_OWNER);
  36.         txMsg.Header.ModuleType = CAN_MODULE_TYPE_SNS_NTC;
  37.         txMsg.Header.ModuleId = sns_NTC_ID;
  38.         txMsg.Header.Command = CAN_MODULE_CMD_PHYSICAL_TEMPERATURE_CELSIUS;
  39.         txMsg.Length = 3;
  40.         txMsg.Data[0] = 0;
  41.         txMsg.Data[1] = (T_10_6>>8)&0xff;
  42.         txMsg.Data[2] = (T_10_6)&0xff;
  43.  
  44.         StdCan_Put(&txMsg);
  45.     }
  46. }
  47.  
  48. void sns_NTC_HandleMessage(StdCan_Msg_t *rxMsg)
  49. {
  50.     if (    StdCan_Ret_class(rxMsg->Header) == CAN_MODULE_CLASS_SNS &&
  51.         StdCan_Ret_direction(rxMsg->Header) == DIRECTIONFLAG_TO_OWNER &&
  52.         rxMsg->Header.ModuleType == CAN_MODULE_TYPE_SNS_NTC &&
  53.         rxMsg->Header.ModuleId == sns_NTC_ID)
  54.     {
  55.         switch (rxMsg->Header.Command)
  56.         {
  57.         case CAN_MODULE_CMD_GLOBAL_REPORT_INTERVAL:
  58.         if (rxMsg->Length > 0)
  59.         {
  60.             sns_NTC_ReportInterval = rxMsg->Data[0];
  61.             Timer_SetTimeout(sns_NTC_TIMER, sns_NTC_ReportInterval*1000 , TimerTypeFreeRunning, 0);
  62.         }
  63.  
  64.         StdCan_Msg_t txMsg;
  65.  
  66.         StdCan_Set_class(txMsg.Header, CAN_MODULE_CLASS_SNS);
  67.         StdCan_Set_direction(txMsg.Header, DIRECTIONFLAG_FROM_OWNER);
  68.         txMsg.Header.ModuleType = CAN_MODULE_TYPE_SNS_NTC;
  69.         txMsg.Header.ModuleId = sns_NTC_ID;
  70.         txMsg.Header.Command = CAN_MODULE_CMD_GLOBAL_REPORT_INTERVAL;
  71.         txMsg.Length = 1;
  72.  
  73.         txMsg.Data[0] = sns_NTC_ReportInterval;
  74.  
  75.         StdCan_Put(&txMsg);
  76.         break;
  77.         }
  78.     }
  79. }
  80.  
  81. void sns_NTC_List(uint8_t ModuleSequenceNumber)
  82. {
  83.     StdCan_Msg_t txMsg;
  84.    
  85.     StdCan_Set_class(txMsg.Header, CAN_MODULE_CLASS_SNS); ///TODO: Change this to the actual class type
  86.     StdCan_Set_direction(txMsg.Header, DIRECTIONFLAG_FROM_OWNER);
  87.     txMsg.Header.ModuleType = CAN_MODULE_TYPE_SNS_NTC; ///TODO: Change this to the actual module type
  88.     txMsg.Header.ModuleId = sns_NTC_ID;
  89.     txMsg.Header.Command = CAN_MODULE_CMD_GLOBAL_LIST;
  90.     txMsg.Length = 6;
  91.  
  92.     uint32_t HwId=BIOS_GetHwId();
  93.     txMsg.Data[0] = HwId&0xff;
  94.     txMsg.Data[1] = (HwId>>8)&0xff;
  95.     txMsg.Data[2] = (HwId>>16)&0xff;
  96.     txMsg.Data[3] = (HwId>>24)&0xff;
  97.    
  98.     txMsg.Data[4] = NUMBER_OF_MODULES;
  99.     txMsg.Data[5] = ModuleSequenceNumber;
  100.    
  101.     while (StdCan_Put(&txMsg) != StdCan_Ret_OK);
  102. }
  103.