take into account the normal for contact force computation
fix bug at compilation
fix