|
|
|
@ -1,7 +1,4 @@ |
|
|
|
|
#!/usr/bin/env python3 |
|
|
|
|
import pstats |
|
|
|
|
import cProfile |
|
|
|
|
|
|
|
|
|
from cereal import car |
|
|
|
|
from common.params import Params |
|
|
|
|
from common.realtime import Priority, config_realtime_process |
|
|
|
@ -35,8 +32,6 @@ def plannerd_thread(sm=None, pm=None): |
|
|
|
|
if pm is None: |
|
|
|
|
pm = messaging.PubMaster(['longitudinalPlan', 'lateralPlan']) |
|
|
|
|
|
|
|
|
|
with cProfile.Profile(builtins=False) as pr: |
|
|
|
|
i = 0 |
|
|
|
|
while True: |
|
|
|
|
sm.update() |
|
|
|
|
|
|
|
|
@ -46,12 +41,6 @@ def plannerd_thread(sm=None, pm=None): |
|
|
|
|
longitudinal_planner.update(sm, CP) |
|
|
|
|
longitudinal_planner.publish(sm, pm) |
|
|
|
|
|
|
|
|
|
i+= 1 |
|
|
|
|
if i == 80: |
|
|
|
|
stats = pstats.Stats(pr) |
|
|
|
|
stats.sort_stats('time') |
|
|
|
|
stats.dump_stats('/tmp/plannerd_stats') |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
def main(sm=None, pm=None): |
|
|
|
|
plannerd_thread(sm, pm) |
|
|
|
|