more motion planner friendly home pose for arms
started refactoring