Merge pull request #417 from arkedge/add_el_on_ph_tlm

テレメのパケット配送での EL 発行の追加

Author: meltingrabbit

system/event_manager/event_logger.h

@@ -220,6 +220,7 @@ typedef enum
   EL_CORE_GROUP_CDIS_EXEC_ERR_CODE,
   EL_CORE_GROUP_PH_ANALYZE_CCP,       //!< PH_analyze_cmd_packet での CCP 配送エラー
   EL_CORE_GROUP_PH_USER_ANALYZE_CCP,  //!< PH_user_analyze_cmd での CCP 配送エラー
+  EL_CORE_GROUP_PH_ANALYZE_CTP,       //!< PH_analyze_tlm_packet での CTP 配送エラー
   // TODO: ComponentDriverSuper
 #ifdef EL_IS_ENABLE_EL_ERROR_LEVEL
   EL_CORE_GROUP_EL_DROP_CLOG1,        //!< EL CLogs で古いエラーを上書きするとき (group, err_level を保存)

tlm_cmd/packet_handler.c

@@ -263,28 +263,56 @@ static PH_ACK PH_add_block_cmd_(const CommonCmdPacket* packet)
 PH_ACK PH_analyze_tlm_packet(const CommonTlmPacket* packet)
 {
   ctp_dest_flags_t flags;
+  PH_ACK ack = PH_ACK_UNKNOWN;
+  PH_ACK last_err_ack = PH_ACK_SUCCESS;
+
   if (!CTP_is_valid_packet(packet)) return PH_ACK_INVALID_PACKET;
 
   flags = CTP_get_dest_flags(packet);
 
   // FIXME: flag の match は関数化したい
 
   // High Priority Realtime Telemetry
-  if (flags & CTP_DEST_FLAG_HP_TLM) PH_add_rt_tlm_(packet);  // hp_tlm のフラグが立っていても，RT_TLMとして処理する方針にした
+  if (flags & CTP_DEST_FLAG_HP_TLM)
+  {
+    ack = PH_add_rt_tlm_(packet);  // hp_tlm のフラグが立っていても，RT_TLM として処理する方針にした
+    if (ack != PH_ACK_SUCCESS) last_err_ack = ack;
+  }
 
   // Realtime Telemetry
-  if (flags & CTP_DEST_FLAG_RT_TLM) PH_add_rt_tlm_(packet);
+  if (flags & CTP_DEST_FLAG_RT_TLM)
+  {
+    ack = PH_add_rt_tlm_(packet);
+    if (ack != PH_ACK_SUCCESS) last_err_ack = ack;
+  }
 
 #ifdef DR_ENABLE
   // Stored Telemetry
-  if (flags & CTP_DEST_FLAG_ST_TLM) PH_add_st_tlm_(packet);
+  if (flags & CTP_DEST_FLAG_ST_TLM)
+  {
+    ack = PH_add_st_tlm_(packet);
+    if (ack != PH_ACK_SUCCESS) last_err_ack = ack;
+  }
 
   // Replay Telemetry
-  if (flags & CTP_DEST_FLAG_RP_TLM) PH_add_rp_tlm_(packet);
+  if (flags & CTP_DEST_FLAG_RP_TLM)
+  {
+    ack = PH_add_rp_tlm_(packet);
+    if (ack != PH_ACK_SUCCESS) last_err_ack = ack;
+  }
 #endif
 
-  // [TODO] 要検討:各Queue毎の登録エラー判定は未実装
-  return PH_ACK_SUCCESS;
+  if (ack == PH_ACK_UNKNOWN)
+  {
+    // どの CTP_DEST_FLAG にもヒットしなかった場合
+    last_err_ack = PH_ACK_UNKNOWN;
+    EL_record_event((EL_GROUP)EL_CORE_GROUP_PH_ANALYZE_CTP,
+                    (uint32_t)( ((0X000000ff & (uint32_t)flags) << 16) | ( 0x0000ffff & (uint32_t)last_err_ack) ),
+                    EL_ERROR_LEVEL_LOW,
+                    CTP_get_id(packet));
+  }
+
+  return last_err_ack;
 }
 
 
@@ -378,7 +406,14 @@ static PH_ACK PH_add_tlm_to_pl(const CommonTlmPacket* packet, PacketList* pl, CT
   PL_Node* tail;
   PL_ACK ack = PL_push_back(pl, packet);
 
-  if (ack != PL_SUCCESS) return PH_ACK_PL_LIST_FULL;
+  if (ack != PL_SUCCESS)
+  {
+    EL_record_event((EL_GROUP)EL_CORE_GROUP_PH_ANALYZE_CTP,
+                    (uint32_t)( ((0X000000ff & (uint32_t)dest_flag) << 16) | ( 0x0000ffff & (uint32_t)PH_ACK_PL_LIST_FULL) ),
+                    EL_ERROR_LEVEL_HIGH,      // packet が失われるので HIGH
+                    CTP_get_id(packet));
+    return PH_ACK_PL_LIST_FULL;
+  }
 
   // 複数の配送先に配送されるパケットの分岐は終わっているため， dest flag を配送先のもののみにする．
   // こうすることで， GS SW 側でのデータベース格納の処理がシンプルになる．