Should work with the stock code, have you seen this?
You would just have the yaw servo on the single motor rather than one for each side.