Poll topics in main loop
Check in which control mode first before receiving data from the respective attitude controller
Initialized all structs with zero in constructor