CH7 SONAR init bug fixed