Added outlier rejection, changed definition of coupling, fixed constraint function
Merge remote-tracking branch 'origin/master'