ime_slam_core organization and gzserver bug treatment