fixed floor_frame_publisher.py