added torque calc to plotData & controllaw ready to choose between trajectory generated reference or not
shark tests and surf inputs