Visualize emergency stop margin in footstep_visualizer

[garaemon]

@YutaKojio

#!/usr/bin/env python

from hrpsys_ros_bridge.srv import OpenHRP_StabilizerService_getParameter as getParameter
import rospy


if __name__ == "__main__":
    rospy.init_node("stabilizer_watcher")
    g_get_parameter_srv = rospy.ServiceProxy("/StabilizerServiceROSBridge/getParameter", getParameter)
    r = rospy.Rate(0.1)
    while not rospy.is_shutdown():
        print g_get_parameter_srv().i_param.cp_check_margin
        r.sleep()