fixing mass projection init bug
free mass matrix allocation
tmp