Added in averaging speed calculator for roll and pitch