added subscribe to joint states, test, start sensor noise test if not simulated