Add contact monitor and initialize footstep marker to hrp2jsknt_real.launch