Merge remote-tracking branch 'tobias/master'
Merge remote-tracking branch 'tobias/master'
add missing return statement. Also catch div by 0 errors.
Merge remote-tracking branch 'max/master'
Merge remote-tracking branch 'tobias/master'
add imu in launch file
some fixes