fix potential mutex problem related to #300
fix potential mutex problem related to #300

facontidavide/PlotJuggler,facontidavide/PlotJuggler,facontidavide/PlotJuggler,facontidavide/PlotJuggler,facontidavide/PlotJuggler