Radar-Inertial ICP-based Pose Graph SLAM