Optimize manipulability measure function