Try multiwii.