add services

drone_scripts/find_id.sh

@@ -0,0 +1,32 @@
+#!/bin/bash
+
+lidarserial=00000000001A
+heightserial=369A378F3439
+
+find_by_id(){
+    v=${1%:*}; p=${1#*:}  # split vid:pid into 2 vars
+    v=${v#${v%%[!0]*}}; p=${p#${p%%[!0]*}}  # strip leading zeros
+    grep -il "^PRODUCT=$v/$p" /sys/bus/usb/devices/*:*/uevent |
+    sed s,uevent,, |
+    xargs -r grep -r '^DEVNAME=' --include uevent
+}
+ids=$(find_by_id 0483:5740)
+echo $ids
+
+for device in $ids
+do
+	id=$(echo $device | cut -d "=" -f 2)
+	serial=$(/bin/udevadm info --name=/dev/$id | grep SERIAL_SHORT | cut -d = -f 2)
+	echo "device "$id" has serial number "$serial
+	if [ $serial = $lidarserial ]
+	then
+		echo "LIDAR on port" $id
+		echo $id > /home/ubuntu/drone_conf/lidar.conf
+	elif [ $serial = $heightserial ]
+	then
+		echo "height sensor on port" $id
+		echo $id > /home/ubuntu/drone_conf/height.conf
+	else
+		echo "unknown serial number" $serial
+	fi
+done

drone_scripts/start_height_sensor.sh

@@ -0,0 +1,10 @@
+#!/bin/bash
+
+. /home/ubuntu/source_ros2.sh
+
+SERIAL=$(cat /home/ubuntu/drone_conf/height.conf)
+echo "serial port is "$SERIAL
+echo ros2 run height height_reader --ros-args -p height_serial_port:=/dev/${SERIAL}
+ros2 run height height_reader --ros-args -p height_serial_port:=/dev/${SERIAL} | tee /home/ubuntu/drone_log/height.log
+
+

drone_scripts/start_lidar.sh

@@ -0,0 +1,10 @@
+#!/bin/bash
+
+. /home/ubuntu/source_ros2.sh
+
+SERIAL=$(cat /home/ubuntu/drone_conf/lidar.conf)
+echo "serial port is "$SERIAL
+echo ros2 run object_detection lidar_reader --ros-args -p lidar_serial_port:=/dev/${SERIAL}
+ros2 run object_detection lidar_reader --ros-args -p lidar_serial_port:=/dev/${SERIAL} | tee /home/ubuntu/drone_log/lidar.log
+
+