Correction if  d(p_g, p_n) &lt;= d   than g(p_g,p_n) = 1 - d(p_g,p_n)/d <div>otherwise  g(p_g,p_n) = 0</div><div>Probably use cosine instead of linear penalization would be more nice. </div>