add head Rotation camera. visualizeGraph
fix bug