Getting ready to delete function 2

Don't need 2nd integration if you set Force normal to zero with an if (fn<=0) fn=0 else (poslowerx)<=0 fn=0.