renamed goal seen topic. Added estop code