added arm controll switch, get joint states, set joint states