Add capability to set depth offset for Airmar DST 200/800 transducers

Author: keesverruijt

airmar/airmar.php

@@ -13,7 +13,11 @@
 $dest = $argv[1];
 $cmd  = $argv[2];
 
-if ($cmd == "request-access-level")
+if ($cmd == "set-depth-offset" && $argc == 4)
+{
+  set_depth_offset($argv[3]);
+}
+else if ($cmd == "request-access-level")
 {
   request_access_level();
 }
@@ -26,27 +30,50 @@ function usage()
 {
   echo "Usage: airmar.php <dest> <command>\n\n";
   echo "where command is one of:\n";
+  echo "    set-depth-offset <offset> in millimeters\n";
   echo "    request-access-level\n";
   echo "and <dest> is the decimal device number of the Airmar sensor on the CAN bus, or 255 for broadcast\n";
   exit(1);
 }
 
-function request_access_level()
+function set_depth_offset($offset)
 {
   global $dest;
 
-  # Usage: ./rel/linux-i586/send-group-function <dest> <prio> <pgn> <field>=<value> ...
-  $command = shell_exec("/usr/local/bin/send-group-function $dest 5 65287 1=135 3=4");
-  echo $command;
+  $command = shell_exec("command-group-function $dest 5 128267 3=" . sprintf("%04x", $offset));
+  $analyzed = shell_exec("echo '$command' | analyzer 2>/dev/null");
+  echo "Sending request to device $dest: $analyzed\n";
 
-  $response = n2k_request_response($command, 'Request Access Level');
-  if (is_array($response[126208][$dest."_0"]))
+  $response = n2k_request_response($command, 'set-depth-offset');
+  show_command_response($response);
+
+  Sleep(0.2);
+  $response = n2k_request_response(null, 'set-depth-offset');
+  if (array_key_exists(128267, $response) && is_array($response[128267]))
   {
-    echo "Looks like the sensor denied the request.\n";
+    echo "New depth sentence\n";
+    print_r($response[128267]);
   }
-  if (is_array($response[65287]))
+}
+
+function request_access_level()
+{
+  global $dest;
+
+  $command = shell_exec("command-group-function $dest 5 65287 1=0087 3=04");
+  echo "Sending request to device $dest to report PGN 65287: $command\n";
+  $analyzed = shell_exec("echo '$command' | analyzer 2>/dev/null");
+  echo "Sending request to device $dest to report PGN 65287: $analyzed\n";
+
+  $response = n2k_request_response($command, 'Request Access Level');
+
+  echo "Response: ".print_r($response);
+
+  show_command_response($response);
+
+  if (array_key_exists(65287, $response) && is_array($response[65287]))
   {
-    echo "Some response received\n";
+    echo "Airmar data received\n";
     $response = $response['65287'];
     print_r($response);
   }
@@ -56,7 +83,7 @@ function n2k_request_response($request, $description = 'N2K')
 {
   $errno = 0;
   $errstr = '';
-  $n2k = @fsockopen('localhost', 2597, &$errno, &$errstr, 15);
+  $n2k = @fsockopen('localhost', 2597, $errno, $errstr, 15);
   if (!$n2k)
   {
     echo "Cannot connect to N2KD: $errstr\n";
@@ -67,7 +94,11 @@ function n2k_request_response($request, $description = 'N2K')
   # Ask for device list
   #
 
-  fwrite($n2k, $request."\n");
+  if ($request !== null)
+  {
+    fwrite($n2k, $request."\n");
+  }
+  $s = '';
   while (!feof($n2k))
   {
     $s .= fgets($n2k, 1024);
@@ -81,4 +112,26 @@ function n2k_request_response($request, $description = 'N2K')
   }
   return $data;
 }
+
+function show_command_response($response)
+{
+  global $dest;
+
+  if (array_key_exists(126208, $response) && is_array($response[126208]))
+  {
+    if (array_key_exists($dest, $response[126208]) && is_array($response[126208][$dest]))
+    {
+      $fields = $response[126208][$dest]['fields'];
+      echo "Device response: ". $fields['Function Code'] . " for PGN " . $fields['PGN'];
+      if ($fields['Parameter Error'] != 0)
+      {
+        echo " - ERROR\n";
+      }
+      else
+      {
+        echo " - OK\n";
+      }
+    }
+  }
+}
 ?>