add naoqi_driver for ros2

src/lhw_qi/Dockerfile

 FROM lhw
 ARG NO_GPU=0
 
+
+RUN sh \
+    -c 'echo "deb http://packages.ros.org/ros/ubuntu `lsb_release -sc` main" \
+        > /etc/apt/sources.list.d/ros-latest.list'
+RUN wget http://packages.ros.org/ros.key -O - | sudo apt-key add -
+RUN apt-get update
+# THis only installs 1.71 which doesn't work for naoqi driver
+# RUN apt-get -y install libboost-all-dev
+
 # Get and build boost
 RUN cd / && wget https://deac-ams.dl.sourceforge.net/project/boost/boost/1.62.0/boost_1_62_0.tar.gz
 RUN cd / && tar zxvf boost_1_62_0.tar.gz && rm boost_1_62_0.tar.gz
 RUN cd /boost_1_62_0 \
-  && ./bootstrap.sh --with-libraries=all --with-toolset=gcc \
-  && ./b2 install -j 8
+ && ./bootstrap.sh --with-libraries=all --with-toolset=gcc \
+ && ./b2 install -j 8
+
+RUN apt-get install ros-foxy-diagnostic-updater
+RUN apt-get install ros-foxy-robot-state-publisher
 
 # Install naoqi c++ sdk
 RUN python3 -m pip install qibuild
@@ -15,6 +27,10 @@ RUN cd /opt && git clone https://github.com/samiamlabs/libqi.git -b release-2.5
 RUN cd /opt/libqi && mkdir build && cd build && cmake .. -DQI_WITH_TESTS=OFF
 RUN cd /opt/libqi/build && make -j 8 && make install
 
+RUN cd /opt && git clone https://github.com/aldebaran/libqicore.git -b release-2.5
+RUN cd /opt/libqicore && mkdir build && cd build && cmake .. -DQI_WITH_TESTS=OFF
+RUN cd /opt/libqicore/build && make -j 8 && make install
+
 # Install dependencies
 COPY src/lhw_interfaces src/lhw_interfaces
 COPY src/lhw_qi src/lhw_qi
@@ -26,5 +42,10 @@ RUN echo "\nsource /workspace/liu-home-wreckers/src/lhw_qi/activate" >> /etc/zsh
 # Will be mounted later
 RUN rm -rf src
 
+# Naoqi ROS packages
+RUN cd /workspace/liu-home-wreckers
+RUN git clone https://github.com/simwijs/naoqi_bridge_msgs -b ros2 src/naoqi_bridge_msgs
+RUN git clone https://github.com/simwijs/naoqi_driver.git -b ros2_integration src/naoqi_driver
+
 # Link
 RUN ldconfig
\ No newline at end of file