Changed initial pose from [-3.0 -2.4 0 0] to [0 0 0 0]