FINISHED

Added graphical output of torque and global variable for weighting
factor of energy conservation in cost function.