Fixed a problem with mutiplication (matrix instead of element wise)
Merge branch 'new_wbi_ID' of https://github.com/robotology-playground/WBI-Toolbox into new_wbi_ID