Fixed sac_model_plane to make sure a valid plane is optimized
Merge pull request #185 from sdmiller/plane_fix

Fixed sac_model_plane to make sure a valid plane is optimized