Working gyro weighted history
work in progress- rc trims based off pid[roll]