cand: fixed segfault introduced by !Marek! ;)

diff --git a/src/cand/cand.cc b/src/cand/cand.cc
index e7ee7233fdaabe265a19fdeda1e0145b747fb598..0a7e4e854915c99546942bc25fcd4a6b5d4dc86b 100644 (file)
--- a/src/cand/cand.cc
+++ b/src/cand/cand.cc
@@ -535,6 +535,8 @@ int main(int argc, char *argv[])
                printf("Roboorte initialization failed! Exiting...\n");
                exit(-1);
        }
+       else
+               printf("Roboorte OK\n");
 
        /* creating publishers */
        robottype_publisher_pwr_voltage_create(&orte, NULL, NULL);
@@ -542,6 +544,9 @@ int main(int argc, char *argv[])
        robottype_publisher_motion_irc_create(&orte, NULL, NULL);
        robottype_publisher_robot_cmd_create(&orte, NULL, NULL);
        robottype_publisher_cmu_create(&orte, NULL, NULL);
+       robottype_publisher_corr_trig_create(&orte, NULL, NULL);
+       robottype_publisher_corr_distances_create(&orte, NULL, NULL);
+       printf("Publishers OK\n");
 
        /* creating subscribers */
        robottype_subscriber_pwr_ctrl_create(&orte, rcv_pwr_ctrl_cb, &orte);
@@ -555,6 +560,8 @@ int main(int argc, char *argv[])
        robottype_subscriber_holder_create(&orte, rcv_holder_cb, &orte);
        robottype_subscriber_pusher_create(&orte, rcv_pusher_cb, &orte);
 
+       printf("subscribers OK\n");
+
        /* main loop */
        for(;;) {
                FD_ZERO(&read_fd_set);