Sensor fusion filter added, some member initialisations recommended by cppcheck added