Add C++ files for friction constraints
Merge branch 'master' of https://github.com/quangounet/TOPP