Publishes SONAR_CONNECTED after initialisation. Should work better now.