Add method which returns worst time (and make some methods const).
Add method which returns worst time (and make some methods const).

robustrobotics/eigen,robustrobotics/eigen,robustrobotics/eigen,robustrobotics/eigen