Added torque rate as a metric using simple Djikstras
Merge branch 'master' of https://github.com/Boberito25/ButlerBot