Added interupt based sonar.  fixed "sleep" mode by removing redundant "removeCan"