added switching hands if that helps with pose reachability (problem: no visualization in RViz)