Trigger mode is now working - wip
Make the sonar to work