Subversion Repositories HomeAutomation

Rev

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

  1.  
  2. #include <drivers/rfid/rfid.h>
  3. #include "sns_rfid.h"
  4.  
  5. uint8_t sns_rfid_got_card = 0;
  6.  
  7. void sns_rfid_Init(void)
  8. {
  9.     rfid_init();
  10.  
  11.     gpio_set_out( sns_rfid_STATUS_LED );
  12. }
  13.  
  14. void sns_rfid_Process(void)
  15. {
  16.     uint8_t version;
  17.     uint32_t id;
  18.     if( 0 == rfid_fetch( &version, &id ) ) {
  19.         if( !sns_rfid_got_card ) {
  20.             sns_rfid_got_card = 1;
  21.             sns_rfid_card.id      = id;
  22.             sns_rfid_card.version = version;
  23.             // Card arrived
  24.             sns_rfid_HandleCardEvent(1);
  25.         }
  26.         Timer_SetTimeout(sns_rfid_CARD_LEFT_TIMER, sns_rfid_CARD_LEFT_TIME, TimerTypeOneShot, 0);
  27.     }
  28.     if ( Timer_Expired(sns_rfid_CARD_LEFT_TIMER) ) {
  29.         sns_rfid_got_card = 0;
  30.         // Card left
  31.         sns_rfid_HandleCardEvent(0);
  32.     }
  33. }
  34.  
  35. void sns_rfid_HandleCardEvent( uint8_t event ) {
  36.     StdCan_Msg_t txMsg;
  37.    
  38.     gpio_set_statement( event, sns_rfid_STATUS_LED );
  39.  
  40.     StdCan_Set_class(txMsg.Header, CAN_MODULE_CLASS_SNS); ///TODO: Change this to the actual class type
  41.     StdCan_Set_direction(txMsg.Header, DIRECTIONFLAG_FROM_OWNER);
  42.     txMsg.Header.ModuleType = CAN_MODULE_TYPE_SNS_RFID; ///TODO: Change this to the actual module type
  43.     txMsg.Header.ModuleId = sns_rfid_ID;
  44.     txMsg.Header.Command = CAN_MODULE_CMD_GLOBAL_LIST;
  45.     txMsg.Length = 6;
  46.  
  47.     txMsg.Data[0] = event;
  48.     txMsg.Data[1] =  sns_rfid_card.version;
  49.     txMsg.Data[2] =  sns_rfid_card.id&0xff;
  50.     txMsg.Data[3] = (sns_rfid_card.id>>8)&0xff;
  51.     txMsg.Data[4] = (sns_rfid_card.id>>16)&0xff;
  52.     txMsg.Data[5] = (sns_rfid_card.id>>24)&0xff;
  53.  
  54.     while (StdCan_Put(&txMsg) != StdCan_Ret_OK);
  55. }
  56.  
  57. void sns_rfid_HandleMessage(StdCan_Msg_t *rxMsg)
  58. {
  59. /*  if (    StdCan_Ret_class(rxMsg->Header) == CAN_MODULE_CLASS_SNS && ///TODO: Change this to the actual class type
  60.         StdCan_Ret_direction(rxMsg->Header) == DIRECTIONFLAG_FROM_OWNER &&
  61.         rxMsg->Header.ModuleType == CAN_MODULE_TYPE_SNS_RFID && ///TODO: Change this to the actual module type
  62.         rxMsg->Header.ModuleId == sns_rfid_ID)
  63.     {
  64.         switch (rxMsg->Header.Command)
  65.         {
  66.         case CAN_CMD_MODULE_DUMMY:
  67.         ///TODO: Do something dummy
  68.         break;
  69.         }
  70.     }*/
  71. }
  72.  
  73. void sns_rfid_List(uint8_t ModuleSequenceNumber)
  74. {
  75.     StdCan_Msg_t txMsg;
  76.  
  77.     StdCan_Set_class(txMsg.Header, CAN_MODULE_CLASS_SNS); ///TODO: Change this to the actual class type
  78.     StdCan_Set_direction(txMsg.Header, DIRECTIONFLAG_FROM_OWNER);
  79.     txMsg.Header.ModuleType = CAN_MODULE_TYPE_SNS_RFID; ///TODO: Change this to the actual module type
  80.     txMsg.Header.ModuleId = sns_rfid_ID;
  81.     txMsg.Header.Command = CAN_MODULE_CMD_GLOBAL_LIST;
  82.     txMsg.Length = 6;
  83.  
  84.     uint32_t HwId=BIOS_GetHwId();
  85.     txMsg.Data[0] = HwId&0xff;
  86.     txMsg.Data[1] = (HwId>>8)&0xff;
  87.     txMsg.Data[2] = (HwId>>16)&0xff;
  88.     txMsg.Data[3] = (HwId>>24)&0xff;
  89.  
  90.     txMsg.Data[4] = NUMBER_OF_MODULES;
  91.     txMsg.Data[5] = ModuleSequenceNumber;
  92.  
  93.     while (StdCan_Put(&txMsg) != StdCan_Ret_OK);
  94. }
  95.