00001 #!/usr/bin/env python 00002 # coding=utf-8 00003 import rospy 00004 import nav_msgs.msg 00005 00006 class