Fixed Bug, it seems. Error in the torque calculation
Fixed bug and visualization tools