Add get mass matrix in friExample test
Add initializeCommand

Send null command to the robot to
sync FRI and KRL commands.
To be used before entering COMMAND mode.