This is how I ended up making a working system. And since this post is so high on the recommended when you search for this problem I thought I would put it here.
(use the split pins thing to get the yaw isolated)