Sensors struct and main loop

[sq2ips]

It would be good to put all sensor variables into one struct and move sensor handling code to separate functions for code readability in main.c.