Action server added. Will navigate some steps forward and then try to align to a cube