Fixed a few bugs and defined thermpCommand message
made a check for the parameters and made them all rosparams