fixing joint angles, adding debug flag to launch