function_0619.py 90 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824
  1. #!/usr/bin/env python
  2. # -*- coding: utf-8 -*-
  3. ##################################################################
  4. #
  5. # Copyright (c) 2023 CICV, Inc. All Rights Reserved
  6. #
  7. ##################################################################
  8. """
  9. @Authors: zhanghaiwen(zhanghaiwen@china-icv.cn), yangzihao(yangzihao@china-icv.cn)
  10. @Data: 2023/08/03
  11. @Last Modified: 2023/08/03
  12. @Summary: Function metrics
  13. """
  14. import sys
  15. sys.path.append('../common')
  16. sys.path.append('../modules')
  17. sys.path.append('../results')
  18. import math
  19. import numpy as np
  20. import pandas as pd
  21. import scipy.signal as sg
  22. from score_weight import cal_score_with_priority, cal_weight_from_80
  23. from common import score_grade, string_concatenate, replace_key_with_value, score_over_100
  24. class Function(object):
  25. """
  26. Class for achieving function metrics for autonomous driving.
  27. Attributes:
  28. df: Vehicle driving data, stored in dataframe format.
  29. """
  30. def __init__(self, data_processed, custom_data, scoreModel):
  31. self.eval_data = pd.DataFrame()
  32. self.data_processed = data_processed
  33. self.scoreModel = scoreModel
  34. self.df = data_processed.object_df
  35. self.ego_df = data_processed.ego_data
  36. self.obj_id_list = data_processed.obj_id_list
  37. self.df_roadmark = data_processed.road_mark_df
  38. self.df_roadpos = data_processed.road_pos_df
  39. self.df_drivectrl = data_processed.driver_ctrl_df
  40. self.unfunc_df = pd.DataFrame(columns=['start_time', 'end_time', 'start_frame', 'end_frame', 'type'])
  41. self.unfunc_follow_df = pd.DataFrame(columns=['start_time', 'end_time', 'start_frame', 'end_frame', 'type'])
  42. self.unfunc_lane_df = pd.DataFrame(columns=['start_time', 'end_time', 'start_frame', 'end_frame', 'type'])
  43. self.unfunc_custom_df = pd.DataFrame(columns=['start_time', 'end_time', 'start_frame', 'end_frame', 'type'])
  44. self.custom_markline_list = []
  45. # config infos for calculating score
  46. self.config = data_processed.config
  47. function_config = self.config.config['function']
  48. self.function_config = function_config
  49. # common data
  50. self.bulitin_metric_list = self.config.builtinMetricList
  51. # dimension data
  52. self.weight_custom = function_config['weightCustom']
  53. self.metric_list = function_config['metric']
  54. self.type_list = function_config['type']
  55. self.type_name_dict = function_config['typeName']
  56. self.name_dict = function_config['name']
  57. self.unit_dict = function_config['unit']
  58. # custom metric data
  59. self.customMetricParam = function_config['customMetricParam']
  60. self.custom_metric_list = list(self.customMetricParam.keys())
  61. self.custom_data = custom_data
  62. self.custom_param_dict = {}
  63. # score data
  64. self.weight = function_config['weightDimension']
  65. self.weight_type_dict = function_config['typeWeight']
  66. self.weight_type_list = function_config['typeWeightList']
  67. self.weight_dict = function_config['weight']
  68. self.weight_list = function_config['weightList']
  69. self.priority_dict = function_config['priority']
  70. self.priority_list = function_config['priorityList']
  71. self.kind_dict = function_config['kind']
  72. self.optimal_dict = function_config['optimal']
  73. self.multiple_dict = function_config['multiple']
  74. self.kind_list = function_config['kindList']
  75. self.optimal_list = function_config['optimalList']
  76. self.multiple_list = function_config['multipleList']
  77. # self.unit_dict = function_config['unit']
  78. self.metric_dict = function_config['typeMetricDict']
  79. if "functionACC" in self.metric_dict.keys():
  80. self.acc_metric_list = self.metric_dict['functionACC']
  81. if "functionLKA" in self.metric_dict.keys():
  82. self.lka_metric_list = self.metric_dict['functionLKA']
  83. # self.acc_metric_list = ['followSpeedDeviation', 'followDistanceDeviation', 'followStopDistance',
  84. # 'followResponseTime']
  85. # self.lka_metric_list = ['laneDistance', 'centerDistanceExpectation', 'centerDistanceStandardDeviation',
  86. # 'centerDistanceMax', 'centerDistanceMin', 'centerDistanceFrequency',
  87. # 'centerDistanceRange']
  88. # custom metric
  89. self.flag_type_dict = {}
  90. # lists of drving control info
  91. self.time_list = data_processed.driver_ctrl_data['time_list']
  92. self.frame_list = data_processed.driver_ctrl_data['frame_list']
  93. self.time_list_follow = []
  94. self.frame_list_follow = []
  95. self.dist_list = []
  96. self.v_deviation_list = []
  97. self.v_relative_list = []
  98. self.dist_deviation_list = []
  99. self.stop_distance_list = []
  100. self.follow_stop_time_start_list = [] # 起停跟车响应时长
  101. self.dist_list_full_time = list()
  102. self.dist_deviation_list_full_time = list()
  103. self.line_dist = []
  104. self.center_dist = []
  105. self.center_dist_with_nan = []
  106. self.center_time_list = []
  107. self.center_frame_list = []
  108. self.ICA_FLAG = False
  109. self.follow_stop_count = 0
  110. self.result = {}
  111. def _following(self, df):
  112. """
  113. 稳定跟车行驶:
  114. 1.稳态控制速度偏差:筛选出跟车行驶数据后,
  115. 2.稳态控制距离偏差
  116. ACC stastus
  117. 0x7: Stand-wait State
  118. 0x6: Stand-active State
  119. 0x5: Passive State
  120. 0x4: Standby State
  121. 0x3: Shut-off State
  122. 0x2: Override State
  123. 0x1: Active State
  124. 0x0: Off
  125. # 速度变化不能以0到非0为参考,要改为从0到0.05的变化,有一个阈值滤波,避免前车车辆抖动误差影响传感器
  126. 弯道行驶: 最小跟随弯道半径
  127. """
  128. # df = self.df[self.df['ACC_status'] == "Active"].copy() # 跟车状态下
  129. # df = self.df[self.df['ACC_status'] == 1].copy() # 跟车状态下
  130. col_list = ['simTime', 'simFrame', 'playerId', 'v', 'posX', 'posY'] # target_id
  131. df = df[col_list].copy()
  132. ego_df = df[df['playerId'] == 1][['simTime', 'simFrame', 'v', 'posX', 'posY']]
  133. # 筛选目标车(同一车道内,距离最近的前车)
  134. # obj_df = df[df['playerId'] == df['target_id']]
  135. target_id = 2
  136. obj_df = df[df['playerId'] == target_id][['simTime', 'simFrame', 'v', 'posX', 'posY']] # 目标车
  137. obj_df = obj_df.rename(columns={'v': 'v_obj', 'posX': 'posX_obj', 'posY': 'posY_obj'})
  138. df_merge = pd.merge(ego_df, obj_df, on=['simTime', 'simFrame'], how='left')
  139. df_merge['v_relative'] = df_merge['v'] - df_merge['v_obj']
  140. df_merge['dist'] = df_merge.apply(
  141. lambda row: self.dist(row['posX'], row['posY'], row['posX_obj'], row['posY_obj']), axis=1)
  142. self.dist_list = df_merge['dist'].values.tolist()
  143. df_merge['time_gap'] = df_merge['dist'] / df_merge['v']
  144. SAFE_TIME_GAP = 3
  145. df_merge['dist_deviation'] = df_merge['time_gap'].apply(
  146. lambda x: 0 if (x >= SAFE_TIME_GAP) else (SAFE_TIME_GAP - x))
  147. df_stop = df_merge[(df_merge['v'] == 0) & (df_merge['v_obj'] == 0)]
  148. stop_distance_list = df_stop['dist'].values.tolist()
  149. self.stop_distance_list = stop_distance_list
  150. t_list = df_stop['simTime'].values.tolist()
  151. stop_group = []
  152. sub_group = []
  153. CONTINUOUS_TIME_PERIOD = 1
  154. CONTINUOUS_FRAME_PERIOD = 13
  155. for i in range(len(t_list)):
  156. if not sub_group or t_list[i] - t_list[i - 1] <= CONTINUOUS_TIME_PERIOD:
  157. sub_group.append(t_list[i])
  158. else:
  159. stop_group.append(sub_group)
  160. sub_group = [t_list[i]]
  161. stop_group.append(sub_group)
  162. stop_group = [g for g in stop_group if len(g) >= CONTINUOUS_FRAME_PERIOD]
  163. self.follow_stop_count = len(stop_group)
  164. # solution 1: 跟车状态下,算法输出预设跟车速度
  165. # df['velocity_deviation'] = abs(df['v'] - df['set_velocity'])
  166. # max_velocity_deviation = df['velocity_deviation'].max()
  167. # solution 2: 跟车状态下,跟车设定速度为目标车速度
  168. # velocity_deviation = []
  169. # distance_deviation = []
  170. # stop_distance = []
  171. #
  172. # for f, data in df.groupby('simFrame'):
  173. # ego_data = data.iloc[0].copy()
  174. # # df.loc[len(df)] = ego_data
  175. #
  176. # if len(data) < 2:
  177. # continue
  178. # v1 = ego_data['v']
  179. # x1 = ego_data['posX']
  180. # y1 = ego_data['posY']
  181. #
  182. # for i in range(1, len(data)):
  183. # obj_data = data.iloc[i].copy()
  184. #
  185. # v2 = obj_data['v']
  186. # x2 = obj_data['posX']
  187. # y2 = obj_data['posY']
  188. #
  189. # v_delta = abs(v1 - v2)
  190. # velocity_deviation.append(v_delta)
  191. #
  192. # dist = self.dist(x1, y1, x2, y2)
  193. # distance_deviation.append(dist)
  194. #
  195. # if v2 == 0 and v1 == 0:
  196. # stop_distance.append(dist)
  197. # df.loc[len(df)] = obj_data
  198. # self.df = df
  199. df_merge.replace([np.inf, -np.inf], np.nan, inplace=True) # 异常值处理
  200. self.time_list_follow = df_merge['simTime'].values.tolist()
  201. self.frame_list_follow = df_merge['simFrame'].values.tolist()
  202. self.v_relative_list = df_merge['v_relative'].values.tolist()
  203. self.v_deviation_list = abs(df_merge['v_relative']).values.tolist()
  204. self.dist_deviation_list = df_merge['dist_deviation'].values.tolist()
  205. tmp_df = self.ego_df[['simTime', 'simFrame']].copy()
  206. v_rel_df = df_merge[['simTime', 'v_relative']].copy()
  207. df_merged1 = pd.merge(tmp_df, v_rel_df, on='simTime', how='left')
  208. self.v_relative_list_full_time = df_merged1['v_relative'].values.tolist()
  209. dist_deviation_df = df_merge[['simTime', 'dist_deviation']].copy()
  210. df_merged1 = pd.merge(tmp_df, dist_deviation_df, on='simTime', how='left')
  211. self.dist_deviation_list_full_time = df_merged1['dist_deviation'].values.tolist()
  212. dist_df = df_merge[['simTime', 'dist']].copy()
  213. df_merged1 = pd.merge(tmp_df, dist_df, on='simTime', how='left')
  214. self.dist_list_full_time = df_merged1['dist'].values.tolist()
  215. max_velocity_deviation = abs(df_merge['v_relative']).max()
  216. distance_deviation = df_merge['dist_deviation'].max()
  217. min_stop_distance = min(self.stop_distance_list) if self.stop_distance_list else 9999
  218. self.result['followSpeedDeviation'] = max_velocity_deviation
  219. self.result['followDistanceDeviation'] = distance_deviation
  220. self.result['followStopDistance'] = min_stop_distance
  221. def _stop_and_go(self, df):
  222. """
  223. 停走功能:
  224. 1.跟停距离3-4m,
  225. 2.启动跟车响应时间<=1.2s
  226. 3.停车跟车响应时间<=1.2s
  227. decisionType_target
  228. 0 无障碍物巡航
  229. 1 停车减速让行
  230. 2 跟车
  231. 3 绕行
  232. 4 到达终点?
  233. """
  234. # df = self.df[self.df['ACC_status'].isin(["Active", "Stand-active", "Stand-wait"])].copy() # 跟车状态下
  235. # df = self.df[self.df['ACC_status'] == 1].copy() # 跟车状态下
  236. STOP_SPEED_THRESHOLD = 0.05
  237. df['v'] = df['v'].apply(lambda x: 0 if x <= STOP_SPEED_THRESHOLD else 1) # 区分速度为0或非0
  238. target_id = 2
  239. df_ego = df[df['playerId'] == 1].copy()
  240. df_obj = df[df['playerId'] == target_id].copy() # 目标车
  241. df_obj_time = df_obj['simTime'].values.tolist()
  242. df_ego = df_ego[df_ego['simTime'].isin(df_obj_time)].copy()
  243. df_ego = df_ego.drop_duplicates(["simTime", "simFrame"])
  244. df_obj = df_obj.drop_duplicates(["simTime", "simFrame"])
  245. df_ego['v_diff'] = df_ego['v'].diff()
  246. df_ego['v_start_flag'] = df_ego['v_diff'].apply(lambda x: 1 if x == 1 else 0) # 起步即为1
  247. df_ego['v_stop_flag'] = df_ego['v_diff'].apply(lambda x: 1 if x == -1 else 0) # 停车即为-1
  248. df_obj['v_diff'] = df_obj['v'].diff()
  249. obj_v_start_flag = df_obj['v_diff'].apply(lambda x: 1 if x == 1 else 0).values # 起步即为1
  250. obj_v_stop_flag = df_obj['v_diff'].apply(lambda x: 1 if x == -1 else 0).values # 停车即为1
  251. df_ego['obj_v_start_flag'] = obj_v_start_flag
  252. df_ego['obj_v_stop_flag'] = obj_v_stop_flag
  253. df_ego['flag_start'] = df_ego['obj_v_start_flag'] - df_ego['v_start_flag'] # 目标车起步即为1,自车起步即为-1
  254. df_ego['flag_stop'] = df_ego['obj_v_stop_flag'] - df_ego['v_stop_flag'] # 目标车停车即为1,自车停车即为-1
  255. flag_start_list = df_ego['flag_start'].values
  256. flag_stop_list = df_ego['flag_stop'].values
  257. time_list = df_ego['simTime'].values
  258. time_start_list = []
  259. time_stop_list = []
  260. for i, flag in enumerate(flag_start_list):
  261. if flag:
  262. t1 = time_list[i]
  263. if flag == -1:
  264. t2 = time_list[i]
  265. time_start_list.append(t2 - t1) # t2-t1即为自车起步响应时间
  266. for i, flag in enumerate(flag_stop_list):
  267. if flag:
  268. t1 = time_list[i]
  269. if flag == -1:
  270. t2 = time_list[i]
  271. time_stop_list.append(t2 - t1) # t2-t1即为自车停车响应时间
  272. time_start_list = [i for i in time_start_list if i != 0]
  273. self.result['followResponseTime'] = max(time_start_list) if time_start_list else 0
  274. self.follow_stop_time_start_list = time_start_list
  275. # self.result['跟车停止响应最长时间'] = max(time_stop_list)
  276. def dist(self, x1, y1, x2, y2):
  277. dis = math.sqrt((x1 - x2) ** 2 + (y1 - y2) ** 2)
  278. return dis
  279. def _line_dist_merge(self):
  280. # line_dist_df = self.df_roadmark[self.df_roadmark['id'] == 0 & self.df_roadmark['id'] == 2].copy()
  281. # line_dist_group = line_dist_df.groupby("simFrame").apply(lambda t: abs(t['lateralDist']).min()).values.tolist()
  282. # line_dist_df['line_dist'] = line_dist_group
  283. # line_dist_df = line_dist_df[['simFrame', 'line_dist']]
  284. # line_dist_df.columns = ['simFrame', 'line_dist']
  285. # line_dist_df = line_dist_df.drop_duplicates()
  286. line_dist_df = self.df_roadmark[(self.df_roadmark['id'] == 0) | (self.df_roadmark['id'] == 2)].copy()
  287. # df = line_dist_df[line_dist_df['id'] == 2][['simTime', 'simFrame']].copy()
  288. # df['line_dist'] = line_dist_df.groupby('simFrame').apply(lambda t: abs(t['lateralDist']).min()).values.tolist()
  289. if line_dist_df.empty:
  290. self.ego_df['line_dist'] = pd.Series(dtype=float)
  291. else:
  292. df = line_dist_df.groupby('simFrame').apply(lambda t: abs(t['lateralDist']).min()).reset_index()
  293. # df = df.rename(columns={'lateralDist': 'line_dist'})
  294. df.columns = ["simFrame", "line_dist"]
  295. self.ego_df = pd.merge(self.ego_df, df, on='simFrame', how='left')
  296. def _lane_transverse_distance(self, df):
  297. """
  298. 0x7:Reserved
  299. 0x6: Reserved
  300. 0x5: Reserved
  301. 0x4: Error
  302. 0x3: Active
  303. 0x2: Standby
  304. 0x1: Passive
  305. 0x0: Off
  306. """
  307. # 车道内偏移行驶时,与近侧车道线的横向距离
  308. # data_group = lane_df.groupby("simFrame").apply(lambda t: abs(t['lateralDist']).min())
  309. # data_group = self.df_roadmark.groupby("simFrame").apply(lambda t: abs(t['lateralDist']).min())
  310. # df = data_group.to_frame(name='line_dist')
  311. # df['simFrame'] = data_group.index.tolist()
  312. # df = self.df_roadmark[self.df_roadmark['id'] == 0][['simTime', 'simFrame']].copy()
  313. # df['line_dist'] = self.df_roadmark.groupby('simFrame').apply(
  314. # lambda t: abs(t['lateralDist']).min()).values.tolist()
  315. # self.ego_df = pd.merge(self.ego_df, df, on=['simTime', 'simFrame'], how='left')
  316. # self._line_dist_merge()
  317. # # df = self.df[self.df['LKA_status'] == 3]
  318. # df = self.ego_df[self.ego_df['LKA_status'] == "Active"]
  319. self.line_dist = df['line_dist'].to_list()
  320. self.line_dist = [x for x in self.line_dist if not np.isnan(x)]
  321. self.result['laneDistance'] = min(self.line_dist) if self.line_dist else self.optimal_dict['laneDistance']
  322. def _lateral_dist_of_center_line(self, df_laneoffset):
  323. # df_laneoffset = self.df[(self.df['LKA_status'] == "Active") & (self.df['playerId'] == 1)]
  324. self.center_dist_with_nan = df_laneoffset['laneOffset'].to_list()
  325. self.center_time_list = df_laneoffset['simTime'].to_list()
  326. self.center_frame_list = df_laneoffset['simFrame'].to_list()
  327. # self.center_dist_df = self.df_roadpos[self.df_roadpos["playerId"] == 1]
  328. # self.center_dist = self.center_dist_df["laneOffset"]
  329. # self.center_time_list = self.center_dist_df['simTime'].to_list()
  330. # self.center_frame_list = self.center_dist_df['simFrame'].to_list()
  331. self.center_dist = [x for x in self.center_dist_with_nan if not np.isnan(x)]
  332. if not self.center_dist:
  333. self.result['centerDistanceExpectation'] = 0
  334. self.result['centerDistanceStandardDeviation'] = 0
  335. # self.result['centerDistanceMax'] = abs(extreme_max_value).max()
  336. # self.result['centerDistanceMin'] = abs(extreme_min_value).min()
  337. self.result['centerDistanceMax'] = 0
  338. self.result['centerDistanceMin'] = 0
  339. self.result['centerDistanceFrequency'] = 0
  340. self.result['centerDistanceRange'] = 0
  341. else:
  342. center_dist = [abs(x) for x in self.center_dist]
  343. # 车道中心线横向距离分布期望与标准差
  344. E_lane_center_dist = np.mean(center_dist)
  345. D_lane_center_dist = np.std(center_dist)
  346. # 车道中心线横向距离分布极值
  347. center_dist = np.array(center_dist)
  348. extrmax_index = sg.argrelmax(center_dist)[0]
  349. extrmin_index = sg.argrelmin(center_dist)[0]
  350. extreme_max_value = center_dist[extrmax_index]
  351. extreme_min_value = center_dist[extrmin_index]
  352. # 横向相对位置震荡频率
  353. # 极值即函数局部的最大值或最小值,周期表示两个极大值之间的时间长度或者两个极小值之间的时间长度
  354. length1 = len(extrmax_index) # 极大值列表长度
  355. length2 = len(extrmin_index) # 极小值列表长度
  356. # 极值下标之间的时间间隔列表乘以每两个下标之间的时间间隔
  357. FREQUENCY = 100
  358. time_diff = 1.0 / FREQUENCY
  359. period1 = time_diff * (extrmax_index[1:length1] - extrmax_index[0:length1 - 1])
  360. period2 = time_diff * (extrmin_index[1:length2] - extrmin_index[0:length2 - 1])
  361. try:
  362. period = (sum(period1) + sum(period2)) / (length1 + length2) # 所有时间间隔(即周期)的均值作为最后的周期
  363. except ZeroDivisionError:
  364. period = 0
  365. frequency = 1 / period if period else 0
  366. # length = min(len(extreme_max_value), len(extreme_min_value))
  367. # period = np.mean(extrmax_index[0:length] - extrmin_index[0:length])
  368. # frequency = 1 / period
  369. # 横向相对位置震荡极差
  370. length = min(len(extreme_max_value), len(extreme_min_value))
  371. extr_diff = extreme_max_value[0:length] - extreme_min_value[0:length]
  372. self.result['centerDistanceExpectation'] = E_lane_center_dist
  373. self.result['centerDistanceStandardDeviation'] = D_lane_center_dist
  374. # self.result['centerDistanceMax'] = abs(extreme_max_value).max()
  375. # self.result['centerDistanceMin'] = abs(extreme_min_value).min()
  376. self.result['centerDistanceMax'] = center_dist.max()
  377. self.result['centerDistanceMin'] = center_dist.min()
  378. self.result['centerDistanceFrequency'] = abs(frequency)
  379. self.result['centerDistanceRange'] = abs(extr_diff).max() if list(extr_diff) else 0
  380. def _continous_judge(self, frame_list):
  381. CONTINUOUS_FRAME_PERIOD = 3
  382. if not frame_list:
  383. return 0
  384. cnt = 1
  385. for i in range(1, len(frame_list)):
  386. if frame_list[i] - frame_list[i - 1] <= CONTINUOUS_FRAME_PERIOD:
  387. continue
  388. cnt += 1
  389. return cnt
  390. def _lane_departure_warning(self, ldw_df):
  391. """
  392. 工作车速范围:55/60-200/250 km/h
  393. 最小可用车道宽度:2.6m
  394. 误报警:距离安全,但是预警
  395. 漏报警:距离危险,但是没报警
  396. 灵敏度差:线外40cm
  397. 灵敏度零级:压线
  398. 灵敏度一级:线内20cm(20%)
  399. 灵敏度二级:线内40cm(40%)
  400. 灵敏度三级:线内60cm(60%)
  401. 偏离车速1.0m/s:线内60cm报警
  402. 偏离车速0.5m/s:线内40cm报警
  403. """
  404. # 自车, 车道线宽度>2.6m,转向灯没开
  405. # ego_df = self.df[self.df['playerId'] == 1].copy()
  406. # ego_df['line_dist'] = self.line_dist
  407. # lane_dist_df = self.df_roadmark[self.df_roadmark['id'] == 0 & self.df_roadmark['id'] == 2].copy()
  408. # lane_dist_group = lane_dist_df.groupby("simFrame").apply(
  409. # lambda t: abs(t['lateralDist']).min()).values.tolist()
  410. # lane_dist_df['line_dist'] = lane_dist_group
  411. # lane_dist_df = lane_dist_df[['simFrame', 'line_dist']]
  412. # lane_dist_df.columns = ['simFrame', 'line_dist']
  413. # # lane_dist_df = lane_dist_df[['simTime', 'simFrame', 'line_dist']]
  414. # # lane_dist_df.columns = ['simTime', 'simFrame', 'line_dist']
  415. # lane_dist_df = lane_dist_df.drop_duplicates()
  416. # ldw_status_df = self.df[self.df['playerId'] == 1].copy()[['simTime', 'simFrame', 'LDW_status']].drop_duplicates()
  417. # ldw_status_df = self.ego_df[['simTime', 'simFrame', 'LDW_status', 'line_dist']].copy().drop_duplicates()
  418. # ldw_df = pd.merge_asof(ldw_status_df, lane_dist_df, on='simFrame', direction='nearest')
  419. # ldw_df = self.ego_df[['simTime', 'simFrame', 'LDW_status', 'line_dist']].copy()
  420. # calculate max DLC
  421. warning_dist_max = ldw_df[ldw_df['LDW_status'] == "Active"]['line_dist'].max()
  422. # warning_dist_max = ldw_df[ldw_df['LDW_status'] == 3]['line_dist'].max()
  423. self.result['预警时距离车道线最大距离'] = warning_dist_max
  424. # count miss warning
  425. miss_warning_df = ldw_df[(ldw_df['line_dist'] <= 0.4) & (ldw_df['LDW_status'] != "Active")]
  426. miss_warning_frame_list = miss_warning_df['simFrame'].values.tolist()
  427. miss_warning_count = self._continous_judge(miss_warning_frame_list)
  428. self.result['车道偏离漏预警次数'] = miss_warning_count
  429. # count false warning
  430. false_warning_df = ldw_df[(ldw_df['line_dist'] >= 0.4) & (ldw_df['LDW_status'] == "Active")]
  431. false_warning_frame_list = false_warning_df['simFrame'].values.tolist()
  432. false_warning_count = self._continous_judge(false_warning_frame_list)
  433. self.result['车道偏离误预警次数'] = false_warning_count
  434. def _autonomous_emergency_brake(self):
  435. """
  436. 刹得准、刹得稳
  437. 碰撞预警 + 紧急制动
  438. <=4s 预警>1s,制动<3s
  439. 触发目标类型
  440. 目标类型准确度
  441. 目标为车辆的速度降:
  442. 弱势目标的速度降:
  443. 触发时TTC<4s
  444. 一级制动减速度:4m/s^2
  445. 二级制动减速度:10m/s^2
  446. 刹停行驶距离:10-20m
  447. 刹停时前车距离:0.8-1.5m
  448. 误触发次数:频率 n/10万km
  449. 漏触发:
  450. 能绕开就没必要刹停:开始刹车时距离远近
  451. Returns:
  452. """
  453. # ego_df = self.df[self.df['playerId'] == 1]
  454. df = self.ego_df[self.ego_df['Aeb_status'] == 'Active']
  455. # df = self.ego_df[self.ego_df['Aeb_status'] == 0]
  456. # calculate brakeDecelerate
  457. df['lon_accel'] = df['accelX'] * np.cos(df['posH']) + df['accelY'] * np.sin(df['posH'])
  458. decelerate_max = df['lon_accel'].min()
  459. # calculate brake stop travelDist
  460. df_dist = df[df['lon_accel'] < 0]
  461. frame_list = df_dist['simFrame'].to_list()
  462. travelDist_list = df_dist['travelDist'].to_list()
  463. travelDist_group = []
  464. start = 0
  465. for i in range(1, len(frame_list)):
  466. if frame_list[i] - frame_list[i - 1] > 5:
  467. end = i - 1
  468. # travelDist_group.append(travelDist_list[start:end])
  469. travelDist_group.append(travelDist_list[end] - travelDist_list[start])
  470. start = i
  471. end = -1
  472. travelDist_group.append(travelDist_list[end] - travelDist_list[start])
  473. brake_distance_max = max(travelDist_group) if travelDist_group else np.inf
  474. self.result['brakeDecelerate'] = abs(round(decelerate_max, 4))
  475. self.result['brakeDistance'] = round(brake_distance_max, 4)
  476. def _integrated_cruise_assist(self, df):
  477. df_LCC = df[df['ICA_status'].isin(['LLC_follow_vehicle', 'LLC_follow_line'])].copy()
  478. self.LCC_line_dist = df_LCC['line_dist'].to_list()
  479. self.result['LCClaneDistance'] = min(self.LCC_line_dist) if self.LCC_line_dist else self.optimal_dict[
  480. 'LCClaneDistance']
  481. self.LCC_center_dist = df_LCC['laneOffset'].to_list()
  482. self.LCC_center_time_list = df_LCC['simTime'].to_list()
  483. self.LCC_center_frame_list = df_LCC['simFrame'].to_list()
  484. if not self.LCC_center_dist:
  485. self.result['LCCcenterDistanceExpectation'] = 0
  486. self.result['LCCcenterDistanceStandardDeviation'] = 0
  487. # self.result['centerDistanceMax'] = abs(extreme_max_value).max()
  488. # self.result['centerDistanceMin'] = abs(extreme_min_value).min()
  489. self.result['LCCcenterDistanceMax'] = 0
  490. self.result['LCCcenterDistanceMin'] = 0
  491. self.result['LCCcenterDistanceFrequency'] = 0
  492. self.result['LCCcenterDistanceRange'] = 0
  493. else:
  494. center_dist = [abs(x) for x in self.LCC_center_dist]
  495. # 车道中心线横向距离分布期望与标准差
  496. E_lane_center_dist = np.mean(center_dist)
  497. D_lane_center_dist = np.std(center_dist)
  498. # 车道中心线横向距离分布极值
  499. center_dist = np.array(center_dist)
  500. extrmax_index = sg.argrelmax(center_dist)[0]
  501. extrmin_index = sg.argrelmin(center_dist)[0]
  502. extreme_max_value = center_dist[extrmax_index]
  503. extreme_min_value = center_dist[extrmin_index]
  504. # 横向相对位置震荡频率
  505. # 极值即函数局部的最大值或最小值,周期表示两个极大值之间的时间长度或者两个极小值之间的时间长度
  506. length1 = len(extrmax_index) # 极大值列表长度
  507. length2 = len(extrmin_index) # 极小值列表长度
  508. # 极值下标之间的时间间隔列表乘以每两个下标之间的时间间隔
  509. FREQUENCY = 100
  510. time_diff = 1.0 / FREQUENCY
  511. period1 = time_diff * (extrmax_index[1:length1] - extrmax_index[0:length1 - 1])
  512. period2 = time_diff * (extrmin_index[1:length2] - extrmin_index[0:length2 - 1])
  513. try:
  514. period = (sum(period1) + sum(period2)) / (length1 + length2) # 所有时间间隔(即周期)的均值作为最后的周期
  515. except ZeroDivisionError:
  516. period = 0
  517. frequency = 1 / period if period else 0
  518. # length = min(len(extreme_max_value), len(extreme_min_value))
  519. # period = np.mean(extrmax_index[0:length] - extrmin_index[0:length])
  520. # frequency = 1 / period
  521. # 横向相对位置震荡极差
  522. length = min(len(extreme_max_value), len(extreme_min_value))
  523. extr_diff = extreme_max_value[0:length] - extreme_min_value[0:length]
  524. self.result['LCCcenterDistanceExpectation'] = E_lane_center_dist
  525. self.result['LCCcenterDistanceStandardDeviation'] = D_lane_center_dist
  526. # self.result['centerDistanceMax'] = abs(extreme_max_value).max()
  527. # self.result['centerDistanceMin'] = abs(extreme_min_value).min()
  528. self.result['LCCcenterDistanceMax'] = center_dist.max()
  529. self.result['LCCcenterDistanceMin'] = center_dist.min()
  530. self.result['LCCcenterDistanceFrequency'] = abs(frequency)
  531. self.result['LCCcenterDistanceRange'] = abs(extr_diff).max() if list(extr_diff) else 0
  532. df_LC = df[df['ICA_status'] == 'Only_Longitudinal_Control'].copy()
  533. v_max = df_LC['v'].max()
  534. v_min = df_LC['v'].min()
  535. self.result['OLC_v_deviation'] = v_max - v_min
  536. def _function_statistic(self):
  537. """
  538. """
  539. ACC_optimal_list = []
  540. if "functionACC" in self.type_list:
  541. if len(self.obj_id_list) > 1:
  542. df_follow = self.df[self.df['ACC_status'] == "Active"].copy() # 跟车状态下
  543. self._following(df_follow)
  544. df_stop_and_go = self.df[
  545. self.df['ACC_status'].isin(["Active", "Stand-active", "Stand-wait"])].copy() # 跟车状态下
  546. self._stop_and_go(df_stop_and_go)
  547. if df_follow.empty and df_stop_and_go.empty:
  548. self.flag_type_dict['functionACC'] = False
  549. else:
  550. self.flag_type_dict['functionACC'] = True
  551. else:
  552. ACC_optimal_list = [value for key, value in self.optimal_dict.items() if key in self.acc_metric_list]
  553. if "functionLKA" in self.type_list:
  554. self._line_dist_merge()
  555. # df_line_dist = self.df[self.df['LKA_status'] == 3]
  556. df_lka = self.ego_df[self.ego_df['LKA_status'] == "Active"]
  557. if df_lka.empty:
  558. self.flag_type_dict['functionLKA'] = False
  559. else:
  560. self.flag_type_dict['functionLKA'] = True
  561. self._lane_transverse_distance(df_lka)
  562. self._lateral_dist_of_center_line(df_lka)
  563. # if "functionLDW" in self.type_list:
  564. # df_ldw = self.ego_df[['simTime', 'simFrame', 'LDW_status', 'line_dist']].copy()
  565. # self._lane_departure_warning(df_ldw)
  566. # if "functionAEB" in self.type_list:
  567. # self._autonomous_emergency_brake()
  568. # if self.df['ICA_status'].nunique() != 1:
  569. # self.ICA_FLAG = True
  570. # # if "functionICA" in self.type_list:
  571. # # self._integrated_cruise_assist(self.ego_df)
  572. # # ACC
  573. # if len(self.obj_id_list) > 1:
  574. # df_follow = self.df[self.df['ACC_status'] == "Shut_off"].copy() # 数字3,对应Active
  575. # self._following(df_follow)
  576. #
  577. # df_stop_and_go = self.df[
  578. # self.df['ACC_status'].isin(["Shut_off", "Stand-active", "Stand-wait"])].copy() # 跟车状态下
  579. # self._stop_and_go(df_stop_and_go)
  580. #
  581. # else:
  582. # ACC_optimal_list = [value for key, value in self.optimal_dict.items() if key in self.acc_metric_list]
  583. #
  584. # # LKA
  585. # self._line_dist_merge()
  586. # # df_line_dist = self.df[self.df['LKA_status'] == 3]
  587. # df_lka = self.ego_df[self.ego_df['ICA_status'] == "LLC_Follow_Line"]
  588. # self._lane_transverse_distance(df_lka)
  589. # self._lateral_dist_of_center_line(df_lka)
  590. arr_func = [value for key, value in self.result.items() if key in self.metric_list]
  591. # arr_func = list(self.result.values())
  592. if "functionACC" in self.type_list and len(self.obj_id_list) == 1:
  593. arr_func = ACC_optimal_list + arr_func
  594. return arr_func
  595. def custom_metric_param_parser(self, param_list):
  596. """
  597. param_dict = {
  598. "paramA" [
  599. {
  600. "kind": "-1",
  601. "optimal": "1",
  602. "multiple": ["0.5","5"],
  603. "spare1": null,
  604. "spare2": null
  605. }
  606. ]
  607. }
  608. """
  609. kind_list = []
  610. optimal_list = []
  611. multiple_list = []
  612. spare_list = []
  613. # spare1_list = []
  614. # spare2_list = []
  615. for i in range(len(param_list)):
  616. kind_list.append(int(param_list[i]['kind']))
  617. optimal_list.append(float(param_list[i]['optimal']))
  618. multiple_list.append([float(x) for x in param_list[i]['multiple']])
  619. spare_list.append([item["param"] for item in param_list[i]["spare"]])
  620. # spare1_list.append(param_list[i]['spare1'])
  621. # spare2_list.append(param_list[i]['spare2'])
  622. result = {
  623. "kind": kind_list,
  624. "optimal": optimal_list,
  625. "multiple": multiple_list,
  626. "spare": spare_list,
  627. # "spare1": spare1_list,
  628. # "spare2": spare2_list
  629. }
  630. return result
  631. def custom_metric_score(self, metric, value, param_list):
  632. """
  633. """
  634. param = self.custom_metric_param_parser(param_list)
  635. self.custom_param_dict[metric] = param
  636. score_model = self.scoreModel(param['kind'], param['optimal'], param['multiple'], np.array([value]))
  637. score_sub = score_model.cal_score()
  638. score = sum(score_sub) / len(score_sub)
  639. return score
  640. def func_score(self):
  641. score_metric_dict = {}
  642. score_type_dict = {}
  643. arr_func = self._function_statistic()
  644. print("\n[功能性表现及得分情况]")
  645. print("功能性各指标值:", [round(num, 2) for num in arr_func])
  646. if arr_func:
  647. arr_func = np.array([arr_func])
  648. score_model = self.scoreModel(self.kind_list, self.optimal_list, self.multiple_list, arr_func)
  649. score_sub = score_model.cal_score()
  650. score_sub = list(map(lambda x: 80 if np.isnan(x) else x, score_sub))
  651. score_metric = [round(num, 2) for num in score_sub]
  652. metric_list = [x for x in self.metric_list if x in self.config.builtinMetricList]
  653. score_metric_dict = {key: value for key, value in zip(metric_list, score_metric)}
  654. flag_custom_type_dict = {}
  655. for metric in self.custom_metric_list:
  656. value = self.custom_data[metric]['value']
  657. param_list = self.customMetricParam[metric]
  658. score = self.custom_metric_score(metric, value, param_list)
  659. score_metric_dict[metric] = round(score, 2)
  660. if 'statusFlag' in self.custom_data[metric].keys():
  661. custom_type, flag_custom_type = next(iter(self.custom_data[metric]['statusFlag'].items()))
  662. if (custom_type in flag_custom_type_dict) and (flag_custom_type == True):
  663. flag_custom_type_dict[custom_type] = True
  664. else:
  665. flag_custom_type_dict[custom_type] = flag_custom_type
  666. flag_custom_type_dict1 = {k: v for k, v in flag_custom_type_dict.items() if v == True}
  667. flag_builtin_type_dict2 = {k: v for k, v in self.flag_type_dict.items() if v == True}
  668. flag_builtin_type_dict2.update(flag_custom_type_dict1)
  669. self.type_list = list(flag_builtin_type_dict2.keys())
  670. self.metric_list = []
  671. for type in self.type_list:
  672. self.metric_list.extend(self.metric_dict[type])
  673. score_metric_dict = {key: score_metric_dict[key] for key in self.metric_list}
  674. score_metric = list(score_metric_dict.values())
  675. if self.weight_custom: # 自定义权重
  676. score_metric_with_weight_dict = {key: score_metric_dict[key] * self.weight_dict[key] for key in
  677. self.weight_dict}
  678. for type in self.type_list:
  679. type_score = sum(
  680. value for key, value in score_metric_with_weight_dict.items() if key in self.metric_dict[type])
  681. score_type_dict[type] = round(type_score, 2) if type_score < 100 else 100
  682. score_type_with_weight_dict = {key: score_type_dict[key] * self.weight_type_dict[key] for key in
  683. score_type_dict}
  684. score_function = sum(score_type_with_weight_dict.values())
  685. else: # 客观赋权
  686. self.weight_list = cal_weight_from_80(score_metric)
  687. self.weight_dict = {key: value for key, value in zip(self.metric_list, self.weight_list)}
  688. score_function = cal_score_with_priority(score_metric, self.weight_list, self.priority_list)
  689. for type in self.type_list:
  690. type_weight = sum(value for key, value in self.weight_dict.items() if key in self.metric_dict[type])
  691. for key, value in self.weight_dict.items():
  692. if key in self.metric_dict[type]:
  693. # self.weight_dict[key] = round(value / type_weight, 4)
  694. self.weight_dict[key] = value / type_weight
  695. type_score_metric = [value for key, value in score_metric_dict.items() if key in self.metric_dict[type]]
  696. type_weight_list = [value for key, value in self.weight_dict.items() if key in self.metric_dict[type]]
  697. type_priority_list = [value for key, value in self.priority_dict.items() if
  698. key in self.metric_dict[type]]
  699. type_score = cal_score_with_priority(type_score_metric, type_weight_list, type_priority_list)
  700. score_type_dict[type] = round(type_score, 2) if type_score < 100 else 100
  701. for key in self.weight_dict:
  702. self.weight_dict[key] = round(self.weight_dict[key], 4)
  703. score_type = list(score_type_dict.values())
  704. self.weight_type_list = cal_weight_from_80(score_type)
  705. self.weight_type_dict = {key: value for key, value in zip(self.type_list, self.weight_type_list)}
  706. score_function = round(score_function, 2)
  707. print(f"功能性得分为:{score_function:.2f}分。")
  708. print(f"功能性各类型得分为:{score_type_dict}分。")
  709. print(f"功能性各指标得分为:{score_metric_dict}。")
  710. return score_function, score_type_dict, score_metric_dict
  711. def continuous_group(self, df):
  712. time_list = df['simTime'].values.tolist()
  713. frame_list = df['simFrame'].values.tolist()
  714. group_time = []
  715. group_frame = []
  716. sub_group_time = []
  717. sub_group_frame = []
  718. for i in range(len(frame_list)):
  719. if not sub_group_time or frame_list[i] - frame_list[i - 1] <= 1:
  720. sub_group_time.append(time_list[i])
  721. sub_group_frame.append(frame_list[i])
  722. else:
  723. group_time.append(sub_group_time)
  724. group_frame.append(sub_group_frame)
  725. sub_group_time = [time_list[i]]
  726. sub_group_frame = [frame_list[i]]
  727. group_time.append(sub_group_time)
  728. group_frame.append(sub_group_frame)
  729. group_time = [g for g in group_time if len(g) >= 2]
  730. group_frame = [g for g in group_frame if len(g) >= 2]
  731. # 输出图表值
  732. time = [[g[0], g[-1]] for g in group_time]
  733. frame = [[g[0], g[-1]] for g in group_frame]
  734. unfunc_time_df = pd.DataFrame(time, columns=['start_time', 'end_time'])
  735. unfunc_frame_df = pd.DataFrame(frame, columns=['start_frame', 'end_frame'])
  736. unfunc_df = pd.concat([unfunc_time_df, unfunc_frame_df], axis=1)
  737. return unfunc_df
  738. def unfunctional_follow_v_deviation_df_statistic(self):
  739. unfunc_df = pd.DataFrame({'simTime': self.time_list_follow, 'simFrame': self.frame_list_follow,
  740. 'v_deviation': self.v_deviation_list})
  741. unfunc_df = unfunc_df[unfunc_df['simFrame'] > 1]
  742. v_df = unfunc_df[unfunc_df['v_deviation'] > self.optimal_dict['followSpeedDeviation']]
  743. v_df = v_df[['simTime', 'simFrame', 'v_deviation']]
  744. v_follow_df = self.continuous_group(v_df)
  745. # v_follow_df['type'] = 'follow'
  746. # v_follow_df['type'] = 'ACC'
  747. v_follow_df['type'] = f"{self.type_name_dict['functionACC']}"
  748. self.unfunc_follow_df = pd.concat([self.unfunc_follow_df, v_follow_df], ignore_index=True)
  749. def unfunctional_follow_dist_deviation_df_statistic(self):
  750. unfunc_df = pd.DataFrame({'simTime': self.time_list_follow, 'simFrame': self.frame_list_follow,
  751. 'dist_deviation': self.dist_deviation_list})
  752. unfunc_df = unfunc_df[unfunc_df['simFrame'] > 1]
  753. dist_df = unfunc_df[unfunc_df['dist_deviation'] > self.optimal_dict['followDistanceDeviation']] # 阈值由1改为了3
  754. dist_df = dist_df[['simTime', 'simFrame', 'dist_deviation']]
  755. dist_follow_df = self.continuous_group(dist_df)
  756. # v_follow_df['type'] = 'follow'
  757. # dist_follow_df['type'] = 'ACC'
  758. dist_follow_df['type'] = f"{self.type_name_dict['functionACC']}"
  759. self.unfunc_follow_df = pd.concat([self.unfunc_follow_df, dist_follow_df], ignore_index=True)
  760. def unfunctional_lane_df_statistic(self):
  761. unfunc_df = pd.DataFrame(
  762. {'simTime': self.center_time_list, 'simFrame': self.center_frame_list,
  763. 'center_dist': self.center_dist_with_nan})
  764. unfunc_df = unfunc_df[unfunc_df['simFrame'] > 1]
  765. unfunc_df = unfunc_df.dropna(subset=['center_dist'])
  766. lane_df = unfunc_df[abs(unfunc_df['center_dist']) > self.optimal_dict['centerDistanceMax']]
  767. lane_df = lane_df[['simTime', 'simFrame', 'center_dist']]
  768. dist_lane_df = self.continuous_group(lane_df)
  769. # dist_lane_df['type'] = 'lane'
  770. # dist_lane_df['type'] = 'LKA'
  771. dist_lane_df['type'] = f"{self.type_name_dict['functionLKA']}"
  772. self.unfunc_lane_df = pd.concat([self.unfunc_lane_df, dist_lane_df], ignore_index=True)
  773. # def zip_time_pairs(self, zip_list, upper_limit=9999):
  774. # zip_time_pairs = zip(self.time_list, zip_list)
  775. # zip_vs_time = [[x, upper_limit if y > upper_limit else y] for x, y in zip_time_pairs if not math.isnan(y)]
  776. # return zip_vs_time
  777. def zip_time_pairs(self, zip_list):
  778. zip_time_pairs = zip(self.time_list, zip_list)
  779. zip_vs_time = [[x, "" if math.isnan(y) else y] for x, y in zip_time_pairs]
  780. return zip_vs_time
  781. def _get_weight_distribution(self, dimension):
  782. # get weight distribution
  783. weight_distribution = {}
  784. weight_distribution["name"] = self.config.dimension_name[dimension]
  785. for type in self.type_list:
  786. type_weight_indexes_dict = {key: f"{self.name_dict[key]}({value * 100:.2f}%)" for key, value in
  787. self.weight_dict.items() if
  788. key in self.metric_dict[type]}
  789. weight_distribution_type = {
  790. "weight": f"{self.type_name_dict[type]}({self.weight_type_dict[type] * 100:.2f}%)",
  791. "indexes": type_weight_indexes_dict
  792. }
  793. weight_distribution[type] = weight_distribution_type
  794. return weight_distribution
  795. def report_statistic(self):
  796. # report_dict = {
  797. # "name": "功能性",
  798. # "weight": f"{self.weight * 100:.2f}%",
  799. # "weightDistribution": weight_distribution,
  800. # "score": score_function,
  801. # "level": grade_function,
  802. # 'score_type': score_type,
  803. # 'score_metric': score_metric,
  804. # 'followStopCount': self.follow_stop_count,
  805. # "description1": func_description1,
  806. # "description2": func_description2,
  807. #
  808. # "functionACC": acc_dict,
  809. # "functionLKA": lka_dict,
  810. #
  811. # "speData": [ego_speed_vs_time, obj_speed_vs_time, rel_speed_vs_time],
  812. # "accData": [lat_acc_vs_time, lon_acc_vs_time],
  813. #
  814. # }
  815. brakePedal_list = self.data_processed.driver_ctrl_data['brakePedal_list']
  816. throttlePedal_list = self.data_processed.driver_ctrl_data['throttlePedal_list']
  817. steeringWheel_list = self.data_processed.driver_ctrl_data['steeringWheel_list']
  818. # common parameter calculate
  819. brake_vs_time = self.zip_time_pairs(brakePedal_list)
  820. throttle_vs_time = self.zip_time_pairs(throttlePedal_list)
  821. steering_vs_time = self.zip_time_pairs(steeringWheel_list)
  822. report_dict = {
  823. "name": self.config.dimension_name["function"],
  824. "weight": f"{self.weight * 100:.2f}%",
  825. 'followStopCount': self.follow_stop_count,
  826. }
  827. # upper_limit = 40
  828. times_upper = 2
  829. # len_time = len(self.time_list)
  830. duration = self.time_list[-1]
  831. # score_function, score_type, score_metric = self.func_score()
  832. score_function, score_type_dict, score_metric_dict = self.func_score()
  833. # get weight distribution
  834. report_dict["weightDistribution"] = self._get_weight_distribution("function")
  835. score_function = int(score_function) if int(score_function) == score_function else round(
  836. score_function, 2)
  837. # score_type = [int(n) if int(n) == n else n for key, n in score_type_dict.items()]
  838. # score_metric = [int(n) if int(n) == n else n for key, n in score_metric_dict.items()]
  839. grade_function = score_grade(score_function)
  840. report_dict["score"] = score_function
  841. report_dict["level"] = grade_function
  842. # report_dict["score_type"] = score_type
  843. # report_dict["score_metric"] = score_metric
  844. # speed data
  845. ego_speed_list = self.ego_df['v'].values.tolist()
  846. ego_speed_vs_time = self.zip_time_pairs(ego_speed_list)
  847. obj_speed_vs_time = []
  848. rel_speed_vs_time = []
  849. # report_dict["speData"] = [ego_speed_vs_time, obj_speed_vs_time, rel_speed_vs_time]
  850. # accData
  851. lat_acc_list = self.ego_df['lat_acc'].values.tolist()
  852. lat_acc_vs_time = self.zip_time_pairs(lat_acc_list)
  853. lon_acc_list = self.ego_df['lon_acc'].values.tolist()
  854. lon_acc_vs_time = self.zip_time_pairs(lon_acc_list)
  855. # acc data
  856. # lat_acc_list = self.ego_df['lat_acc'].values.tolist()
  857. # lat_acc_vs_time = self.zip_time_pairs(lat_acc_list)
  858. # lon_acc_list = self.ego_df['lon_acc'].values.tolist()
  859. # lon_acc_vs_time = self.zip_time_pairs(lon_acc_list)
  860. # report_dict["accData"] = [lat_acc_vs_time, lon_acc_vs_time]
  861. # statistic type report infos
  862. unfunc_metric_list = []
  863. func_over_optimal = []
  864. # function description
  865. func_type_list = []
  866. unfunc_type_list = []
  867. type_details_dict = {}
  868. for type in self.type_list:
  869. if type == "functionACC":
  870. builtin_graph_dict = {}
  871. custom_graph_dict = {}
  872. if len(self.obj_id_list) == 1:
  873. follow_description1 = "无目标车数据可计算;"
  874. follow_description2 = ""
  875. follow_description3 = "无目标车数据可计算;"
  876. follow_description4 = "无目标车数据可计算;"
  877. acc_dict_indexes = {}
  878. for metric in self.metric_dict[type]:
  879. acc_dict_indexes[metric] = {
  880. # "name": f"{self.name_dict[metric]}({self.unit_dict[metric]})",
  881. "name": f"{self.name_dict[metric]}",
  882. "score": 80,
  883. "avg": "-",
  884. "max": "-",
  885. "min": "-",
  886. }
  887. if self.kind_dict[metric] == -1:
  888. acc_dict_indexes[metric]["range"] = f"[0, {self.optimal_dict[metric]}]"
  889. elif self.kind_dict[metric] == 1:
  890. acc_dict_indexes[metric]["range"] = f"[{self.optimal_dict[metric]}, inf)"
  891. elif self.kind_dict[metric] == 0:
  892. acc_dict_indexes[metric][
  893. "range"] = f"[{self.optimal_dict[metric] * self.multiple_dict[metric][0]}, {self.optimal_dict[metric] * self.multiple_dict[metric][1]}]"
  894. acc_dict = {
  895. "name": f"{self.type_name_dict[type]}",
  896. "score": 80,
  897. "level": "良好",
  898. "description1": follow_description1,
  899. "description2": follow_description2,
  900. "description3": follow_description3,
  901. "description4": follow_description4,
  902. "noObjectCar": True,
  903. "indexes": acc_dict_indexes,
  904. "builtin": {},
  905. "custom": {}
  906. }
  907. # follow cruise description
  908. func_follow_metric_list = []
  909. unfunc_follow_metric_list = []
  910. str_follow_over_optimal = ''
  911. distance_vs_time = self.zip_time_pairs(self.dist_list_full_time)
  912. else:
  913. acc_dict = {
  914. "name": f"{self.type_name_dict[type]}",
  915. "noObjectCar": False,
  916. }
  917. # follow dict
  918. score_follow = score_type_dict[type]
  919. grade_follow = score_grade(score_follow)
  920. acc_dict["score"] = score_follow
  921. acc_dict["level"] = grade_follow
  922. unfunc_type_list.append(type) if score_type_dict[type] < 80 else func_type_list.append(type)
  923. # follow cruise description
  924. func_follow_metric_list = []
  925. unfunc_follow_metric_list = []
  926. for metric in self.metric_dict[type]:
  927. unfunc_follow_metric_list.append(metric) if score_metric_dict[
  928. metric] < 80 else func_follow_metric_list.append(
  929. metric)
  930. str_follow_over_optimal = ''
  931. if not unfunc_follow_metric_list:
  932. str_func_follow_metric = string_concatenate(func_follow_metric_list)
  933. follow_description1 = f"{str_func_follow_metric}指标均表现良好"
  934. else:
  935. for metric in unfunc_follow_metric_list:
  936. if metric in self.bulitin_metric_list:
  937. value = self.result[metric]
  938. if self.kind_dict[metric] == -1:
  939. metric_over_optimal = ((value - self.optimal_dict[metric]) / self.optimal_dict[
  940. metric]) * 100
  941. elif self.kind_dict[metric] == 1:
  942. metric_over_optimal = ((self.optimal_dict[metric] - value) / self.optimal_dict[
  943. metric]) * 100
  944. elif self.kind_dict[metric] == 0:
  945. metric_over_optimal = (abs(self.optimal_dict[metric] - value) / self.optimal_dict[
  946. metric]) * 100
  947. else:
  948. value = self.custom_data[metric]["value"][0]
  949. if self.custom_param_dict[metric]['kind'][0] == -1:
  950. metric_over_optimal = ((value - self.custom_param_dict[metric]['optimal'][0]) /
  951. self.custom_param_dict[metric]['optimal'][0]) * 100
  952. elif self.custom_param_dict[metric]['kind'][0] == 1:
  953. metric_over_optimal = ((self.custom_param_dict[metric]['optimal'][0] - value) /
  954. self.custom_param_dict[metric]['optimal'][0]) * 100
  955. elif self.custom_param_dict[metric]['kind'][0] == 0:
  956. metric_over_optimal = (abs(self.custom_param_dict[metric]['optimal'][0] - value) /
  957. self.custom_param_dict[metric]['optimal'][0]) * 100
  958. # str_follow_over_optimal += f"{metric}为{value:.2f},超过合理范围{metric_over_optimal:.2f}%;"
  959. str_follow_over_optimal += f"{metric}为{value:.2f}{self.unit_dict[metric]},超过合理范围{metric_over_optimal:.2f}%;"
  960. str_follow_over_optimal = str_follow_over_optimal[:-1] if str_follow_over_optimal else ""
  961. str_func_follow_metric = string_concatenate(func_follow_metric_list)
  962. str_unfunc_follow_metric = string_concatenate(unfunc_follow_metric_list)
  963. if not func_follow_metric_list:
  964. follow_description1 = f"{str_unfunc_follow_metric}指标表现不佳。{str_follow_over_optimal}"
  965. else:
  966. follow_description1 = f"{str_func_follow_metric}指标表现良好,{str_unfunc_follow_metric}指标表现不佳。{str_follow_over_optimal}"
  967. # for follow_description2
  968. follow_duration = (len(self.time_list_follow) - 2) * 0.04 if self.time_list_follow else 0
  969. follow_description2 = f"自车在行驶时有{follow_duration:.2f}s处于跟车状态,"
  970. follow_description3 = ""
  971. if "followResponseTime" in self.metric_list:
  972. # for follow_description3
  973. cnt3_1 = len(self.follow_stop_time_start_list)
  974. tmp3_list = [x for x in self.follow_stop_time_start_list if
  975. x > self.optimal_dict['followResponseTime']]
  976. cnt3_2 = len(tmp3_list)
  977. percent3 = 0 if cnt3_1 == 0 else round(cnt3_2 / cnt3_1 * 100, 2)
  978. follow_description3 = f"起停跟车响应时间有{cnt3_2}次超出合理范围,占比为{percent3}%;"
  979. follow_description4 = ""
  980. if "followDistanceDeviation" in self.metric_list:
  981. # for follow_description4
  982. cnt4_1 = len(self.stop_distance_list)
  983. tmp4_list = [x for x in self.stop_distance_list if
  984. x < self.optimal_dict['followDistanceDeviation']]
  985. cnt4_2 = len(tmp4_list)
  986. percent4 = 0 if cnt4_1 == 0 else round(cnt4_2 / cnt4_1 * 100, 2)
  987. follow_description4 = f"在本次测试中,跟车状态下目标车共发生了{cnt4_1}次停车,有{cnt4_2}次超出合理范围,占比为{percent4}%;"
  988. # distance_list = obj_df['dist'].values.tolist()
  989. # distance_deviation_vs_time = self.zip_time_pairs(self.dist_deviation_list_full_time)
  990. #
  991. # acc_dict["description1"] = replace_key_with_value(follow_description1, self.name_dict)
  992. # acc_dict["description2"] = replace_key_with_value(follow_description2, self.name_dict)
  993. # acc_dict["description3"] = replace_key_with_value(follow_description3, self.name_dict)
  994. # acc_dict["description4"] = replace_key_with_value(follow_description4, self.name_dict)
  995. # common parameter calculate
  996. obj_df = self.df[self.df['playerId'] == 2]
  997. obj_speed_list = obj_df['v'].values.tolist()
  998. obj_speed_vs_time = self.zip_time_pairs(obj_speed_list)
  999. rel_speed_vs_time = self.zip_time_pairs(self.v_relative_list_full_time)
  1000. distance_vs_time = self.zip_time_pairs(self.dist_list_full_time)
  1001. # acc_dict["speData"] = [ego_speed_vs_time, obj_speed_vs_time, rel_speed_vs_time]
  1002. # acc_dict["disData"] = distance_vs_time
  1003. unfunc_follow_df = self.unfunc_follow_df.copy()
  1004. unfunc_follow_df['type'] = "origin"
  1005. unfunc_follow_slices = unfunc_follow_df.to_dict('records')
  1006. # acc_dict["speMarkLine"] = unfunc_follow_slices
  1007. # acc_dict["disMarkLine"] = unfunc_follow_slices
  1008. distance_deviation_vs_time = self.zip_time_pairs(self.dist_deviation_list_full_time)
  1009. # function ACC data
  1010. acc_dict_indexes = {}
  1011. for metric in self.metric_dict[type]:
  1012. if metric == "followSpeedDeviation":
  1013. self.unfunctional_follow_v_deviation_df_statistic()
  1014. unfunc_v_df = self.unfunc_follow_df.copy()
  1015. unfunc_v_df.loc[unfunc_v_df['type'] != 'ACC', 'type'] = "origin"
  1016. # unfunc_v_df.loc[unfunc_v_df['type'] == 'time', 'type'] = "time"
  1017. unfunc_v_slices = unfunc_v_df.to_dict('records')
  1018. df1 = self.unfunc_follow_df[self.unfunc_follow_df['type'] == 'ACC']
  1019. df1['v_time'] = df1['end_time'] - df1['start_time']
  1020. devi_v_time = df1['v_time'].sum()
  1021. follow_duration = (len(self.time_list_follow) - 2) * 0.04 if self.time_list_follow else 0
  1022. percent2_1 = devi_v_time / follow_duration * 100 if follow_duration else 0
  1023. if devi_v_time != 0:
  1024. follow_description2 += f"跟车状态下自车和目标车的速度差共有{devi_v_time:.2f}s超出合理范围,占比为{percent2_1:.2f}%;"
  1025. else:
  1026. follow_description2 += "跟车状态下自车和目标车的速度差均在合理范围内;"
  1027. v_deviation_list = [x for x in self.v_deviation_list if not np.isnan(x)]
  1028. acc_dict_indexes["followSpeedDeviation"] = {
  1029. # "name": f"{self.name_dict[metric]}({self.unit_dict[metric]})",
  1030. "name": f"{self.name_dict[metric]}",
  1031. "score": score_metric_dict[
  1032. "followSpeedDeviation"],
  1033. "avg": f'{np.mean(v_deviation_list):.2f}' if v_deviation_list else '-',
  1034. "max": f'{max(v_deviation_list):.2f}' if v_deviation_list else '-',
  1035. "min": f'{min(v_deviation_list):.2f}' if v_deviation_list else '-',
  1036. # "range": f"[0, {self.optimal_dict['followSpeedDeviation']}]"
  1037. "range": f"[-{self.optimal_dict['followSpeedDeviation']}, {self.optimal_dict['followSpeedDeviation']}]"
  1038. }
  1039. fsd_data = {
  1040. # "name": f"{self.name_dict[metric]}({self.unit_dict[metric]})",
  1041. "name": f"{self.name_dict[metric]}",
  1042. "data": rel_speed_vs_time,
  1043. "range": f"[-{self.optimal_dict['followSpeedDeviation']}, {self.optimal_dict['followSpeedDeviation']}]",
  1044. # "range": f"[0, {self.optimal_dict['followSpeedDeviation']}]",
  1045. # "markLine": unfunc_v_slices,
  1046. # "markLine2": [-1 * self.optimal_dict['followSpeedDeviation'],
  1047. # self.optimal_dict['followSpeedDeviation']],
  1048. }
  1049. builtin_graph_dict["followSpeedDeviation"] = fsd_data
  1050. if metric == "followDistanceDeviation":
  1051. self.unfunctional_follow_dist_deviation_df_statistic()
  1052. unfunc_dist_df = self.unfunc_follow_df.copy()
  1053. unfunc_dist_df.loc[unfunc_dist_df['type'] != 'ACC', 'type'] = "origin"
  1054. # unfunc_dist_df.loc[unfunc_dist_df['type'] == 'distance', 'type'] = "distance"
  1055. unfunc_dist_slices = unfunc_dist_df.to_dict('records')
  1056. df2 = self.unfunc_follow_df[self.unfunc_follow_df['type'] == 'ACC']
  1057. df2['dist_time'] = df2['end_time'] - df2['start_time']
  1058. devi_dist_time = df2['dist_time'].sum()
  1059. follow_duration = (len(self.time_list_follow) - 2) * 0.04 if self.time_list_follow else 0
  1060. percent2_2 = devi_dist_time / follow_duration * 100 if follow_duration else 0
  1061. if devi_dist_time != 0:
  1062. follow_description2 += f"跟车状态下自车和目标车的距离差共有{devi_dist_time:.2f}s超出合理范围,占比为{percent2_2:.2f}%;"
  1063. else:
  1064. follow_description2 += "跟车状态下自车和目标车的距离差均在合理范围内;"
  1065. dist_deviation_list = [x for x in self.dist_deviation_list if not np.isnan(x)]
  1066. acc_dict_indexes["followDistanceDeviation"] = {
  1067. # "name": f"{self.name_dict[metric]}({self.unit_dict[metric]})",
  1068. "name": f"{self.name_dict[metric]}",
  1069. "score": score_metric_dict[
  1070. "followDistanceDeviation"],
  1071. "avg": f'{np.mean(dist_deviation_list):.2f}' if dist_deviation_list else '-',
  1072. "max": f'{max(dist_deviation_list):.2f}' if dist_deviation_list else '-',
  1073. "min": f'{min(dist_deviation_list):.2f}' if dist_deviation_list else '-',
  1074. "range": f"[0, {self.optimal_dict['followDistanceDeviation']}]"
  1075. }
  1076. fdd_data = {
  1077. # "name": f"{self.name_dict[metric]}({self.unit_dict[metric]})",
  1078. "name": f"{self.name_dict[metric]}",
  1079. "data": distance_deviation_vs_time,
  1080. "range": f"[0, {self.optimal_dict['followDistanceDeviation']}]",
  1081. # "markLine": unfunc_dist_slices,
  1082. # "markLine2": [self.optimal_dict['followDistanceDeviation']],
  1083. }
  1084. builtin_graph_dict["followDistanceDeviation"] = fdd_data
  1085. if metric == "followStopDistance":
  1086. acc_dict_indexes["followStopDistance"] = {
  1087. # "name": f"{self.name_dict[metric]}({self.unit_dict[metric]})",
  1088. "name": f"{self.name_dict[metric]}",
  1089. "score": score_metric_dict[
  1090. "followStopDistance"],
  1091. "avg": f'{np.mean(self.stop_distance_list):.2f}' if self.stop_distance_list else '-',
  1092. "max": f'{max(self.stop_distance_list):.2f}' if self.stop_distance_list else '-',
  1093. "min": f'{min(self.stop_distance_list):.2f}' if self.stop_distance_list else '-',
  1094. "range": f"[{self.optimal_dict['followStopDistance']}, inf)"
  1095. }
  1096. # sdd_data = {
  1097. # # "name": f"{self.name_dict[metric]}({self.unit_dict[metric]})",
  1098. # "name": f"{self.name_dict[metric]}",
  1099. # "data": self.stop_distance_list,
  1100. # "range": f"[{self.optimal_dict['followStopDistance']}, inf)",
  1101. # # "ref": [self.optimal_dict['followStopDistance'] - 1,
  1102. # # self.optimal_dict['followStopDistance']],
  1103. # }
  1104. # builtin_graph_dict["followStopDistance"] = sdd_data
  1105. if metric == "followResponseTime":
  1106. acc_dict_indexes["followResponseTime"] = {
  1107. # "name": f"{self.name_dict[metric]}({self.unit_dict[metric]})",
  1108. "name": f"{self.name_dict[metric]}",
  1109. "score": score_metric_dict["followResponseTime"],
  1110. "avg": f'{np.mean(self.follow_stop_time_start_list):.2f}' if self.follow_stop_time_start_list else '-',
  1111. "max": f'{max(self.follow_stop_time_start_list):.2f}' if self.follow_stop_time_start_list else '-',
  1112. "min": f'{min(self.follow_stop_time_start_list):.2f}' if self.follow_stop_time_start_list else '-',
  1113. "range": f"[0, {self.optimal_dict['followResponseTime']}]"
  1114. }
  1115. # rt_data = {
  1116. # # "name": f"{self.name_dict[metric]}({self.unit_dict[metric]})",
  1117. # "name": f"{self.name_dict[metric]}",
  1118. # "data": self.follow_stop_time_start_list,
  1119. # # "range": f"[0, {self.optimal_dict['followResponseTime']})"
  1120. # }
  1121. # builtin_graph_dict["followResponseTime"] = rt_data
  1122. if metric not in self.bulitin_metric_list:
  1123. acc_dict_indexes[metric] = {
  1124. # "name": f"{self.name_dict[metric]}({self.unit_dict[metric]})",
  1125. "name": f"{self.name_dict[metric]}",
  1126. "score": score_metric_dict[metric],
  1127. "avg": self.custom_data[metric]['tableData']['avg'],
  1128. "max": self.custom_data[metric]['tableData']['max'],
  1129. "min": self.custom_data[metric]['tableData']['min'],
  1130. }
  1131. if self.custom_param_dict[metric]['kind'][0] == -1:
  1132. acc_dict_indexes[metric][
  1133. "range"] = f"[0, {self.custom_param_dict[metric]['optimal'][0]}]"
  1134. elif self.custom_param_dict[metric]['kind'][0] == 1:
  1135. acc_dict_indexes[metric][
  1136. "range"] = f"[{self.custom_param_dict[metric]['optimal'][0]}, inf)"
  1137. elif self.custom_param_dict[metric]['kind'][0] == 0:
  1138. acc_dict_indexes[metric][
  1139. "range"] = f"[{self.custom_param_dict[metric]['optimal'][0] * self.custom_param_dict[metric]['multiple'][0][0]}, {self.custom_param_dict[metric]['optimal'][0] * self.custom_param_dict[metric]['multiple'][0][1]}]"
  1140. custom_graph_dict[metric] = self.custom_data[metric]["reportData"]
  1141. self.custom_markline_list.extend(self.custom_data[metric]["reportData"]['markLine'])
  1142. acc_dict["indexes"] = acc_dict_indexes
  1143. acc_dict["builtin"] = builtin_graph_dict
  1144. acc_dict["custom"] = custom_graph_dict
  1145. acc_dict["description1"] = replace_key_with_value(follow_description1, self.name_dict)
  1146. acc_dict["description2"] = replace_key_with_value(follow_description2, self.name_dict)
  1147. acc_dict["description3"] = replace_key_with_value(follow_description3, self.name_dict)
  1148. acc_dict["description4"] = replace_key_with_value(follow_description4, self.name_dict)
  1149. type_details_dict[type] = acc_dict
  1150. unfunc_metric_list += unfunc_follow_metric_list
  1151. func_over_optimal.append(str_follow_over_optimal)
  1152. elif type == "functionLKA":
  1153. lka_dict = {
  1154. "name": f"{self.type_name_dict[type]}",
  1155. }
  1156. builtin_graph_dict = {}
  1157. custom_graph_dict = {}
  1158. # get score and grade
  1159. score_lane = score_type_dict["functionLKA"]
  1160. grade_lane = score_grade(score_lane)
  1161. lka_dict['score'] = score_lane
  1162. lka_dict['level'] = grade_lane
  1163. # unfunc_type_list.append('车道保持') if score_type_dict["functionLKA"] < 80 else func_type_list.append(
  1164. # '车道保持')
  1165. unfunc_type_list.append(type) if score_type_dict[type] < 80 else func_type_list.append(type)
  1166. # lane keep description
  1167. func_lane_metric_list = []
  1168. unfunc_lane_metric_list = []
  1169. for metric in self.metric_dict[type]:
  1170. unfunc_lane_metric_list.append(metric) if score_metric_dict[
  1171. metric] < 80 else func_lane_metric_list.append(
  1172. metric)
  1173. lka_dict_indexes = {}
  1174. for metric in self.metric_dict[type]:
  1175. if metric == "laneDistance":
  1176. lka_dict_indexes["laneDistance"] = {
  1177. # "name": f"{self.name_dict[metric]}({self.unit_dict[metric]})",
  1178. "name": f"{self.name_dict[metric]}",
  1179. "score": score_metric_dict["laneDistance"],
  1180. "avg": f'{np.mean(self.line_dist):.2f}' if self.line_dist else "-",
  1181. "max": f'{max(self.line_dist):.2f}' if self.line_dist else "-",
  1182. "min": f'{min(self.line_dist):.2f}' if self.line_dist else "-",
  1183. "range": f"[{self.optimal_dict['laneDistance']}, 1.875]"
  1184. }
  1185. if metric == "centerDistanceExpectation":
  1186. lka_dict_indexes["centerDistanceExpectation"] = {
  1187. # "name": f"{self.name_dict[metric]}({self.unit_dict[metric]})",
  1188. "name": f"{self.name_dict[metric]}",
  1189. "score": score_metric_dict['centerDistanceExpectation'],
  1190. "avg": f'{self.result["centerDistanceExpectation"]:.2f}' if self.center_dist else "-",
  1191. "max": "-",
  1192. "min": "-",
  1193. "range": f"[0, {self.optimal_dict['centerDistanceExpectation']}]"
  1194. }
  1195. if metric == "centerDistanceStandardDeviation":
  1196. lka_dict_indexes["centerDistanceStandardDeviation"] = {
  1197. # "name": f"{self.name_dict[metric]}({self.unit_dict[metric]})",
  1198. "name": f"{self.name_dict[metric]}",
  1199. "score": score_metric_dict['centerDistanceStandardDeviation'],
  1200. "avg": f'{self.result["centerDistanceStandardDeviation"]:.2f}' if self.center_dist else "-",
  1201. "max": "-",
  1202. "min": "-",
  1203. "range": f"[0, {self.optimal_dict['centerDistanceStandardDeviation']}]"
  1204. }
  1205. if metric == "centerDistanceMax":
  1206. lka_dict_indexes["centerDistanceMax"] = {
  1207. # "name": f"{self.name_dict[metric]}({self.unit_dict[metric]})",
  1208. "name": f"{self.name_dict[metric]}",
  1209. "score": score_metric_dict['centerDistanceMax'],
  1210. "avg": "-",
  1211. "max": f'{self.result["centerDistanceMax"]:.2f}' if self.center_dist else "-",
  1212. "min": "-",
  1213. "range": f"[0, {self.optimal_dict['centerDistanceMax']}]"
  1214. }
  1215. if metric == "centerDistanceMin":
  1216. lka_dict_indexes["centerDistanceMin"] = {
  1217. # "name": f"{self.name_dict[metric]}({self.unit_dict[metric]})",
  1218. "name": f"{self.name_dict[metric]}",
  1219. "score": score_metric_dict['centerDistanceMin'],
  1220. "avg": "-",
  1221. "max": "-",
  1222. "min": f'{self.result["centerDistanceMin"]:.2f}' if self.center_dist else "-",
  1223. "range": f"[0, {self.optimal_dict['centerDistanceMin']}]"
  1224. }
  1225. if metric == "centerDistanceFrequency":
  1226. lka_dict_indexes["centerDistanceFrequency"] = {
  1227. # "name": f"{self.name_dict[metric]}({self.unit_dict[metric]})",
  1228. "name": f"{self.name_dict[metric]}",
  1229. "score": score_metric_dict['centerDistanceFrequency'],
  1230. "avg": f'{self.result["centerDistanceFrequency"]:.2f}' if self.center_dist else "-",
  1231. "max": "-",
  1232. "min": "-",
  1233. "range": f"[0, {self.optimal_dict['centerDistanceFrequency']}]"
  1234. }
  1235. if metric == "centerDistanceRange":
  1236. lka_dict_indexes["centerDistanceRange"] = {
  1237. # "name": f"{self.name_dict[metric]}({self.unit_dict[metric]})",
  1238. "name": f"{self.name_dict[metric]}",
  1239. "score": score_metric_dict['centerDistanceRange'],
  1240. "avg": f'{self.result["centerDistanceRange"]:.2f}' if self.center_dist else "-",
  1241. "max": "-",
  1242. "min": "-",
  1243. "range": f"[0, {self.optimal_dict['centerDistanceRange']}]"
  1244. }
  1245. if metric not in self.bulitin_metric_list:
  1246. lka_dict_indexes[metric] = {
  1247. # "name": self.custom_data[metric]['name'],
  1248. # "name": f"{self.name_dict[metric]}({self.unit_dict[metric]})",
  1249. "name": f"{self.name_dict[metric]}",
  1250. "score": score_metric_dict[metric],
  1251. "avg": self.custom_data[metric]['tableData']['avg'],
  1252. "max": self.custom_data[metric]['tableData']['max'],
  1253. "min": self.custom_data[metric]['tableData']['min'],
  1254. }
  1255. if self.custom_param_dict[metric]['kind'][0] == -1:
  1256. lka_dict_indexes[metric]["range"] = f"[0, {self.custom_param_dict[metric]['optimal'][0]}]"
  1257. elif self.custom_param_dict[metric]['kind'][0] == 1:
  1258. lka_dict_indexes[metric][
  1259. "range"] = f"[{self.custom_param_dict[metric]['optimal'][0]}, inf)"
  1260. elif self.custom_param_dict[metric]['kind'][0] == 0:
  1261. lka_dict_indexes[metric][
  1262. "range"] = f"[{self.custom_param_dict[metric]['optimal'][0] * self.custom_param_dict[metric]['multiple'][0][0]}, {self.custom_param_dict[metric]['optimal'][0] * self.custom_param_dict[metric]['multiple'][0][1]}]"
  1263. custom_graph_dict[metric] = self.custom_data[metric]["reportData"]
  1264. self.custom_markline_list.extend(self.custom_data[metric]["reportData"]['markLine'])
  1265. lka_dict["indexes"] = lka_dict_indexes
  1266. str_lane_over_optimal = ''
  1267. if not unfunc_lane_metric_list:
  1268. str_func_lane_metric = string_concatenate(func_lane_metric_list)
  1269. lane_description1 = f"{str_func_lane_metric}指标均表现良好"
  1270. else:
  1271. for metric in unfunc_lane_metric_list:
  1272. if metric in self.bulitin_metric_list:
  1273. value = self.result[metric]
  1274. if self.kind_dict[metric] == -1:
  1275. metric_over_optimal = ((value - self.optimal_dict[metric]) / self.optimal_dict[
  1276. metric]) * 100
  1277. elif self.kind_dict[metric] == 1:
  1278. metric_over_optimal = ((self.optimal_dict[metric] - value) / self.optimal_dict[
  1279. metric]) * 100
  1280. elif self.kind_dict[metric] == 0:
  1281. metric_over_optimal = (abs(self.optimal_dict[metric] - value) / self.optimal_dict[
  1282. metric]) * 100
  1283. else:
  1284. value = self.custom_data[metric]["value"][0]
  1285. if self.custom_param_dict[metric]['kind'][0] == -1:
  1286. metric_over_optimal = ((value - self.custom_param_dict[metric]['optimal'][0]) /
  1287. self.custom_param_dict[metric]['optimal'][0]) * 100
  1288. elif self.custom_param_dict[metric]['kind'][0] == 1:
  1289. metric_over_optimal = ((self.custom_param_dict[metric]['optimal'][0] - value) /
  1290. self.custom_param_dict[metric]['optimal'][0]) * 100
  1291. elif self.custom_param_dict[metric]['kind'][0] == 0:
  1292. metric_over_optimal = (abs(self.custom_param_dict[metric]['optimal'][0] - value) /
  1293. self.custom_param_dict[metric]['optimal'][0]) * 100
  1294. str_lane_over_optimal += f"{metric}为{value:.2f}{self.unit_dict[metric]},超过合理范围{metric_over_optimal:.2f}%;"
  1295. str_lane_over_optimal = str_lane_over_optimal[:-1] if str_lane_over_optimal else ""
  1296. str_func_lane_metric = string_concatenate(func_lane_metric_list)
  1297. str_unfunc_lane_metric = string_concatenate(unfunc_lane_metric_list)
  1298. if not func_lane_metric_list:
  1299. lane_description1 = f"{str_unfunc_lane_metric}指标表现不佳。{str_lane_over_optimal}"
  1300. else:
  1301. lane_description1 = f"{str_func_lane_metric}指标表现良好,{str_unfunc_lane_metric}指标表现不佳。{str_lane_over_optimal}"
  1302. lane_description2 = ""
  1303. center_distance_vs_time = []
  1304. if "centerDistanceMax" in self.metric_list:
  1305. cnt2_1 = len(self.center_dist)
  1306. tmp2_list = [x for x in self.center_dist if x > self.optimal_dict['centerDistanceMax']]
  1307. cnt2_2 = len(tmp2_list)
  1308. percent2 = 0 if cnt2_1 == 0 else (cnt2_2 / cnt2_1 * 100)
  1309. dist_time = percent2 * duration / 100
  1310. if dist_time != 0:
  1311. lane_description2 = f"距离有{dist_time:.2f}秒超出合理范围,占比为{percent2:.2f}%"
  1312. else:
  1313. lane_description2 = f"距离均在合理范围内,算法车道保持表现良好"
  1314. # lane keep data for graph
  1315. # center_distance_vs_time = self.zip_time_pairs(self.center_dist)
  1316. center_distance_vs_time = self.zip_time_pairs(self.center_dist_with_nan)
  1317. self.unfunctional_lane_df_statistic()
  1318. #
  1319. # lka_dict["description1"] = replace_key_with_value(lane_description1, self.name_dict)
  1320. # lka_dict["description2"] = lane_description2
  1321. unfunc_lane_df = self.unfunc_lane_df.copy()
  1322. unfunc_lane_df['type'] = "origin"
  1323. unfunc_lane_slices = unfunc_lane_df.to_dict('records')
  1324. unfunc_lane_dist_df = self.unfunc_lane_df.copy()
  1325. unfunc_lane_dist_df.loc[unfunc_lane_dist_df['type'] != 'LKA', 'type'] = "origin"
  1326. unfunc_lane_dist_slices = unfunc_lane_dist_df.to_dict('records')
  1327. lka_data = {
  1328. "name": "车辆中心线横向距离(m)",
  1329. "data": center_distance_vs_time,
  1330. # "markLine": unfunc_lane_dist_slices
  1331. }
  1332. if 'centerDistanceMax' in self.optimal_dict:
  1333. lka_range = f"[0, {self.optimal_dict['centerDistanceMax']}]"
  1334. elif 'centerDistanceMin' in self.optimal_dict:
  1335. lka_range = f"[0, {self.optimal_dict['centerDistanceMin']}]"
  1336. else:
  1337. lka_range = f"[0, 0.5]"
  1338. lka_data["range"] = lka_range
  1339. builtin_graph_dict["centerDistance"] = lka_data
  1340. lka_dict["builtin"] = builtin_graph_dict
  1341. lka_dict["custom"] = custom_graph_dict
  1342. lka_dict["description1"] = replace_key_with_value(lane_description1, self.name_dict)
  1343. lka_dict["description2"] = lane_description2
  1344. # lka_dict["centerDisData"] = center_distance_vs_time
  1345. # lka_dict["centerDisMarkLine"] = unfunc_lane_dist_slices
  1346. type_details_dict[type] = lka_dict
  1347. unfunc_metric_list += unfunc_lane_metric_list
  1348. func_over_optimal.append(str_lane_over_optimal)
  1349. else:
  1350. type_dict = {
  1351. "name": f"{self.type_name_dict[type]}",
  1352. }
  1353. builtin_graph_dict = {}
  1354. custom_graph_dict = {}
  1355. # get score and grade
  1356. score_custom_type = score_type_dict[type]
  1357. grade_custom_type = score_grade(score_custom_type)
  1358. type_dict["score"] = score_custom_type
  1359. type_dict["level"] = grade_custom_type
  1360. # custom type description
  1361. good_custom_metric_list = []
  1362. bad_custom_metric_list = []
  1363. unfunc_type_list.append(type) if score_type_dict[type] < 80 else func_type_list.append(type)
  1364. type_dict_indexes = {}
  1365. for metric in self.metric_dict[type]:
  1366. bad_custom_metric_list.append(metric) if score_metric_dict[
  1367. metric] < 80 else good_custom_metric_list.append(
  1368. metric)
  1369. type_dict_indexes[metric] = {
  1370. # "name": self.custom_data[metric]['name'],
  1371. # "name": f"{self.name_dict[metric]}({self.unit_dict[metric]})",
  1372. "name": f"{self.name_dict[metric]}",
  1373. "score": score_metric_dict[metric],
  1374. "avg": self.custom_data[metric]['tableData']['avg'],
  1375. "max": self.custom_data[metric]['tableData']['max'],
  1376. "min": self.custom_data[metric]['tableData']['min'],
  1377. }
  1378. if self.custom_param_dict[metric]['kind'][0] == -1:
  1379. type_dict_indexes[metric]["range"] = f"[0, {self.custom_param_dict[metric]['optimal'][0]}]"
  1380. elif self.custom_param_dict[metric]['kind'][0] == 1:
  1381. type_dict_indexes[metric]["range"] = f"[{self.custom_param_dict[metric]['optimal'][0]}, inf)"
  1382. elif self.custom_param_dict[metric]['kind'][0] == 0:
  1383. type_dict_indexes[metric][
  1384. "range"] = f"[{self.custom_param_dict[metric]['optimal'][0] * self.custom_param_dict[metric]['multiple'][0][0]}, {self.custom_param_dict[metric]['optimal'][0] * self.custom_param_dict[metric]['multiple'][0][1]}]"
  1385. custom_graph_dict[metric] = self.custom_data[metric]['reportData']
  1386. self.custom_markline_list.extend(self.custom_data[metric]["reportData"]['markLine'])
  1387. type_dict["indexes"] = type_dict_indexes
  1388. str_type_over_optimal = ""
  1389. if not bad_custom_metric_list:
  1390. str_good_custom_metric = string_concatenate(good_custom_metric_list)
  1391. type_description = f"{str_good_custom_metric}指标均表现良好"
  1392. else:
  1393. for metric in bad_custom_metric_list:
  1394. value = self.custom_data[metric]["value"][0]
  1395. if self.custom_param_dict[metric]['kind'][0] == -1:
  1396. metric_over_optimal = ((value - self.custom_param_dict[metric]['optimal'][0]) /
  1397. self.custom_param_dict[metric]['optimal'][0]) * 100
  1398. elif self.custom_param_dict[metric]['kind'][0] == 1:
  1399. metric_over_optimal = ((self.custom_param_dict[metric]['optimal'][0] - value) /
  1400. self.custom_param_dict[metric]['optimal'][0]) * 100
  1401. elif self.custom_param_dict[metric]['kind'][0] == 0:
  1402. metric_over_optimal = (abs(self.custom_param_dict[metric]['optimal'][0] - value) /
  1403. self.custom_param_dict[metric]['optimal'][0]) * 100
  1404. str_type_over_optimal += f"{metric}为{value:.2f}{self.unit_dict[metric]},超过合理范围{metric_over_optimal:.2f}%;"
  1405. str_type_over_optimal = str_type_over_optimal[:-1]
  1406. str_good_custom_metric = string_concatenate(good_custom_metric_list)
  1407. str_bad_custom_metric = string_concatenate(bad_custom_metric_list)
  1408. if not good_custom_metric_list:
  1409. type_description = f"{str_bad_custom_metric}指标表现不佳。{str_type_over_optimal}"
  1410. else:
  1411. type_description = f"{str_good_custom_metric}指标表现良好,{str_bad_custom_metric}指标表现不佳。{str_type_over_optimal}"
  1412. type_dict["builtin"] = builtin_graph_dict
  1413. type_dict["custom"] = custom_graph_dict
  1414. type_dict["description"] = replace_key_with_value(type_description, self.name_dict)
  1415. type_details_dict[type] = type_dict
  1416. unfunc_metric_list += bad_custom_metric_list
  1417. func_over_optimal.append(str_type_over_optimal)
  1418. report_dict["details"] = type_details_dict
  1419. # report_dict["speData"] = [ego_speed_vs_time, obj_speed_vs_time, rel_speed_vs_time]
  1420. func_over_optimal = [s for s in func_over_optimal if s]
  1421. str_func_over_optimal = ';'.join(func_over_optimal)
  1422. if grade_function == '优秀':
  1423. str_func_type = string_concatenate(func_type_list)
  1424. func_description1 = f'算法在{str_func_type}功能上表现优秀;'
  1425. elif grade_function == '良好':
  1426. str_func_type = string_concatenate(func_type_list)
  1427. func_description1 = f'算法在{str_func_type}功能上总体表现良好,满足设计指标要求;'
  1428. elif grade_function == '一般':
  1429. str_unfunc_type = string_concatenate(unfunc_type_list)
  1430. str_unfunc_metric = string_concatenate(unfunc_metric_list)
  1431. str_unfunc_metric = replace_key_with_value(str_unfunc_metric, self.type_name_dict)
  1432. func_description1 = f'算法在{str_unfunc_type}功能上表现一般、需要在{str_unfunc_metric}指标上进一步优化。其中,{str_func_over_optimal};'
  1433. elif grade_function == '较差':
  1434. str_unfunc_type = string_concatenate(unfunc_type_list)
  1435. func_description1 = f'算法在{str_unfunc_type}功能上表现较差,需要提高算法的功能性表现。其中,{str_func_over_optimal};'
  1436. if not unfunc_type_list:
  1437. func_description2 = '功能性在各个功能上的表现俱佳。'
  1438. else:
  1439. str_unfunc_type = string_concatenate(unfunc_type_list)
  1440. func_description2 = f"算法在{str_unfunc_type}功能上需要重点优化。"
  1441. # report_dict["description1"] = replace_key_with_value(func_description1, self.name_dict)
  1442. report_dict["description1"] = replace_key_with_value(replace_key_with_value(func_description1, self.name_dict),
  1443. self.type_name_dict)
  1444. report_dict["description2"] = replace_key_with_value(func_description2, self.type_name_dict)
  1445. report_dict['commonData'] = {
  1446. "per": {
  1447. "name": "脚刹/油门踏板开度(百分比)",
  1448. "legend": ["刹车踏板开度", "油门踏板开度"],
  1449. "data": [brake_vs_time, throttle_vs_time]
  1450. },
  1451. "ang": {
  1452. "name": "方向盘转角(角度°)",
  1453. "data": steering_vs_time
  1454. },
  1455. "spe": {
  1456. "name": "速度(km/h)",
  1457. "legend": ["自车速度", "目标车速度", "自车与目标车相对速度"],
  1458. "data": [ego_speed_vs_time, obj_speed_vs_time, rel_speed_vs_time]
  1459. },
  1460. "acc": {
  1461. "name": "加速度(m/s²)",
  1462. "legend": ["横向加速度", "纵向加速度"],
  1463. "data": [lat_acc_vs_time, lon_acc_vs_time]
  1464. },
  1465. # "dis": {
  1466. # "name": "前车距离(m)",
  1467. # "data": distance_vs_time
  1468. # }
  1469. }
  1470. if "functionACC" in self.type_list:
  1471. report_dict['commonData']["dis"] = {
  1472. "name": "前车距离(m)",
  1473. "data": distance_vs_time
  1474. }
  1475. self.unfunc_df = pd.concat([self.unfunc_df, self.unfunc_follow_df, self.unfunc_lane_df], ignore_index=True)
  1476. unfunc_df = self.unfunc_df.copy()
  1477. unfunc_slices = unfunc_df.to_dict('records')
  1478. unfunc_slices.extend(self.custom_markline_list)
  1479. report_dict["commonMarkLine"] = unfunc_slices
  1480. # report_dict = {
  1481. # "name": "功能性",
  1482. # "weight": f"{self.weight * 100:.2f}%",
  1483. # "weightDistribution": weight_distribution,
  1484. # "score": score_function,
  1485. # "level": grade_function,
  1486. # 'followStopCount': self.follow_stop_count,
  1487. # "description1": func_description1,
  1488. # "description2": func_description2,
  1489. #
  1490. # "functionACC": acc_dict,
  1491. # "functionLKA": lka_dict,
  1492. #
  1493. # "speData": [ego_speed_vs_time, obj_speed_vs_time, rel_speed_vs_time],
  1494. # "accData": [lat_acc_vs_time, lon_acc_vs_time],
  1495. #
  1496. # }
  1497. self.eval_data = self.ego_df.copy()
  1498. return report_dict
  1499. def get_eval_data(self):
  1500. if 'line_dist' in self.eval_data.columns:
  1501. df = self.eval_data[['simTime', 'simFrame', 'playerId', 'lat_acc_roc', 'lon_acc_roc', 'line_dist']].copy()
  1502. else:
  1503. df = self.eval_data[['simTime', 'simFrame', 'playerId', 'lat_acc_roc', 'lon_acc_roc']].copy()
  1504. self.df['line_dist'] = pd.Series(dtype=float)
  1505. return df