Add facing_visualizer.cpp to refactor codes