MotionPlanner: add some benchmarking code
MotionPlanner: add some benchmarking code

fixator/aprinter,johnkingsley/aprinter,johnkingsley/aprinter,fixator/aprinter,johnkingsley/aprinter,ambrop72/aprinter,ambrop72/aprinter,ambrop72/aprinter,ambrop72/aprinter,johnkingsley/aprinter,johnkingsley/aprinter,ambrop72/aprinter,fixator/aprinter,ambrop72/aprinter,fixator/aprinter,johnkingsley/aprinter,ambrop72/aprinter,fixator/aprinter,johnkingsley/aprinter,fixator/aprinter