another attempt with a filter
added the filter from Jose Julio's ArduIMU quadcopter