Added gravity compensation and derivative term. Also changed default ini file to the correct one
Merge branch 'new_wbi_ID' of https://github.com/robotology-playground/WBI-Toolbox into new_wbi_ID