-- The C compiler identification is GNU 11.4.0
-- The CXX compiler identification is GNU 11.4.0
-- Detecting C compiler ABI info
-- Detecting C compiler ABI info - done
-- Check for working C compiler: /usr/bin/cc - skipped
-- Detecting C compile features
-- Detecting C compile features - done
-- Detecting CXX compiler ABI info
-- Detecting CXX compiler ABI info - done
-- Check for working CXX compiler: /usr/bin/c++ - skipped
-- Detecting CXX compile features
-- Detecting CXX compile features - done
-- Found ament_cmake: 1.3.12 (/opt/ros/humble/share/ament_cmake/cmake)
-- Found Python3: /usr/bin/python3 (found version "3.10.12") found components: Interpreter 
-- Found rclcpp: 16.0.16 (/opt/ros/humble/share/rclcpp/cmake)
-- Found rosidl_generator_c: 3.1.7 (/opt/ros/humble/share/rosidl_generator_c/cmake)
-- Found rosidl_adapter: 3.1.7 (/opt/ros/humble/share/rosidl_adapter/cmake)
-- Found rosidl_generator_cpp: 3.1.7 (/opt/ros/humble/share/rosidl_generator_cpp/cmake)
-- Using all available rosidl_typesupport_c: rosidl_typesupport_fastrtps_c;rosidl_typesupport_introspection_c
-- Using all available rosidl_typesupport_cpp: rosidl_typesupport_fastrtps_cpp;rosidl_typesupport_introspection_cpp
-- Found rmw_implementation_cmake: 6.1.2 (/opt/ros/humble/share/rmw_implementation_cmake/cmake)
-- Found rmw_cyclonedds_cpp: 1.3.4 (/opt/ros/humble/share/rmw_cyclonedds_cpp/cmake)
-- Using RMW implementation 'rmw_cyclonedds_cpp' as default
-- Looking for pthread.h
-- Looking for pthread.h - found
-- Performing Test CMAKE_HAVE_LIBC_PTHREAD
-- Performing Test CMAKE_HAVE_LIBC_PTHREAD - Success
-- Found Threads: TRUE  
-- Found advrobotics_lab3_interfaces: 0.0.0 (/home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_interfaces/share/advrobotics_lab3_interfaces/cmake)
-- Found ament_lint_auto: 0.12.14 (/opt/ros/humble/share/ament_lint_auto/cmake)
-- Added test 'cppcheck' to perform static code analysis on C / C++ code
-- Configured cppcheck include dirs: /home/ros/EENG4/AdvancedRobotics_Lab3/src/advrobotics_lab3_ros2/include;/home/ros/EENG4/AdvancedRobotics_Lab3/src/advrobotics_lab3_ros2/include/toolkit-dynamixel
-- Configured cppcheck exclude dirs and/or files: 
-- Added test 'lint_cmake' to check CMake code style
-- Added test 'uncrustify' to check C / C++ code style
-- Configured uncrustify additional arguments: 
-- Added test 'xmllint' to check XML markup files
-- Configuring done
-- Generating done
-- Build files have been written to: /home/ros/EENG4/AdvancedRobotics_Lab3/src/build/advrobotics_lab3_ros2
[ 22%] [32mBuilding CXX object CMakeFiles/poppy_core.dir/src/PoppyDriver.cpp.o[0m
[ 22%] [32mBuilding CXX object CMakeFiles/poppy_core.dir/src/toolkit-dynamixel/DynamixelHandler.cpp.o[0m
[ 33%] [32mBuilding CXX object CMakeFiles/ik_server.dir/src/ik_server.cpp.o[0m
[ 44%] [32mBuilding CXX object CMakeFiles/ik_client.dir/src/ik_client.cpp.o[0m
In file included from [01m[K/home/ros/EENG4/AdvancedRobotics_Lab3/src/advrobotics_lab3_ros2/src/toolkit-dynamixel/DynamixelHandler.cpp:1[m[K:
[01m[K/home/ros/EENG4/AdvancedRobotics_Lab3/src/advrobotics_lab3_ros2/include/toolkit-dynamixel/DynamixelHandler.h:[m[K In constructor ‘[01m[KDynamixelHandler::DynamixelHandler()[m[K’:
[01m[K/home/ros/EENG4/AdvancedRobotics_Lab3/src/advrobotics_lab3_ros2/include/toolkit-dynamixel/DynamixelHandler.h:72:35:[m[K [01;35m[Kwarning: [m[K‘[01m[KDynamixelHandler::m_pPacketHandler[m[K’ will be initialized after [[01;35m[K]8;;https://gcc.gnu.org/onlinedocs/gcc/Warning-Options.html#index-Wreorder-Wreorder]8;;[m[K]
   72 |         dynamixel::PacketHandler* [01;35m[Km_pPacketHandler[m[K;
      |                                   [01;35m[K^~~~~~~~~~~~~~~~[m[K
[01m[K/home/ros/EENG4/AdvancedRobotics_Lab3/src/advrobotics_lab3_ros2/include/toolkit-dynamixel/DynamixelHandler.h:71:33:[m[K [01;35m[Kwarning: [m[K  ‘[01m[Kdynamixel::PortHandler* DynamixelHandler::m_pPortHandler[m[K’ [[01;35m[K]8;;https://gcc.gnu.org/onlinedocs/gcc/Warning-Options.html#index-Wreorder-Wreorder]8;;[m[K]
   71 |         dynamixel::PortHandler* [01;35m[Km_pPortHandler[m[K;
      |                                 [01;35m[K^~~~~~~~~~~~~~[m[K
[01m[K/home/ros/EENG4/AdvancedRobotics_Lab3/src/advrobotics_lab3_ros2/src/toolkit-dynamixel/DynamixelHandler.cpp:3:1:[m[K [01;35m[Kwarning: [m[K  when initialized here [[01;35m[K]8;;https://gcc.gnu.org/onlinedocs/gcc/Warning-Options.html#index-Wreorder-Wreorder]8;;[m[K]
    3 | [01;35m[KDynamixelHandler[m[K::DynamixelHandler():
      | [01;35m[K^~~~~~~~~~~~~~~~[m[K
In file included from [01m[K/home/ros/EENG4/AdvancedRobotics_Lab3/src/advrobotics_lab3_ros2/src/toolkit-dynamixel/DynamixelHandler.cpp:1[m[K:
[01m[K/home/ros/EENG4/AdvancedRobotics_Lab3/src/advrobotics_lab3_ros2/include/toolkit-dynamixel/DynamixelHandler.h:80:17:[m[K [01;35m[Kwarning: [m[K‘[01m[KDynamixelHandler::m_ui8DxlError[m[K’ will be initialized after [[01;35m[K]8;;https://gcc.gnu.org/onlinedocs/gcc/Warning-Options.html#index-Wreorder-Wreorder]8;;[m[K]
   80 |         uint8_t [01;35m[Km_ui8DxlError[m[K;                          // Dynamixel error
      |                 [01;35m[K^~~~~~~~~~~~~[m[K
[01m[K/home/ros/EENG4/AdvancedRobotics_Lab3/src/advrobotics_lab3_ros2/include/toolkit-dynamixel/DynamixelHandler.h:79:13:[m[K [01;35m[Kwarning: [m[K  ‘[01m[Kint DynamixelHandler::m_i32DxlCommunicationResult[m[K’ [[01;35m[K]8;;https://gcc.gnu.org/onlinedocs/gcc/Warning-Options.html#index-Wreorder-Wreorder]8;;[m[K]
   79 |         int [01;35m[Km_i32DxlCommunicationResult[m[K;             // Communication result
      |             [01;35m[K^~~~~~~~~~~~~~~~~~~~~~~~~~~[m[K
[01m[K/home/ros/EENG4/AdvancedRobotics_Lab3/src/advrobotics_lab3_ros2/src/toolkit-dynamixel/DynamixelHandler.cpp:3:1:[m[K [01;35m[Kwarning: [m[K  when initialized here [[01;35m[K]8;;https://gcc.gnu.org/onlinedocs/gcc/Warning-Options.html#index-Wreorder-Wreorder]8;;[m[K]
    3 | [01;35m[KDynamixelHandler[m[K::DynamixelHandler():
      | [01;35m[K^~~~~~~~~~~~~~~~[m[K
[01m[K/home/ros/EENG4/AdvancedRobotics_Lab3/src/advrobotics_lab3_ros2/src/toolkit-dynamixel/DynamixelHandler.cpp:[m[K In member function ‘[01m[Kbool DynamixelHandler::sendTargetJointPosition(std::vector<short unsigned int>&)[m[K’:
[01m[K/home/ros/EENG4/AdvancedRobotics_Lab3/src/advrobotics_lab3_ros2/src/toolkit-dynamixel/DynamixelHandler.cpp:208:26:[m[K [01;35m[Kwarning: [m[Kunused variable ‘[01m[Kdxl_present_position[m[K’ [[01;35m[K]8;;https://gcc.gnu.org/onlinedocs/gcc/Warning-Options.html#index-Wunused-variable-Wunused-variable]8;;[m[K]
  208 |                 uint16_t [01;35m[Kdxl_present_position[m[K = 0;
      |                          [01;35m[K^~~~~~~~~~~~~~~~~~~~[m[K
[ 55%] [32mBuilding CXX object CMakeFiles/ik_client.dir/src/Kinematics.cpp.o[0m
[01m[K/home/ros/EENG4/AdvancedRobotics_Lab3/src/advrobotics_lab3_ros2/src/Kinematics.cpp:[m[K In function ‘[01m[Kstd::vector<float> computeInverseKinematics(float, float, float, float, float, float)[m[K’:
[01m[K/home/ros/EENG4/AdvancedRobotics_Lab3/src/advrobotics_lab3_ros2/src/Kinematics.cpp:43:20:[m[K [01;35m[Kwarning: [m[Ksuggest parentheses around comparison in operand of ‘[01m[K|[m[K’ [[01;35m[K]8;;https://gcc.gnu.org/onlinedocs/gcc/Warning-Options.html#index-Wparentheses-Wparentheses]8;;[m[K]
   43 |         if ([01;35m[Kcos_q3 >1[m[K | cos_q3 <-1)
      |             [01;35m[K~~~~~~~^~[m[K
[ 66%] [32mBuilding CXX object CMakeFiles/ik_server.dir/src/Kinematics.cpp.o[0m
[01m[K/home/ros/EENG4/AdvancedRobotics_Lab3/src/advrobotics_lab3_ros2/src/Kinematics.cpp:[m[K In function ‘[01m[Kstd::vector<float> computeInverseKinematics(float, float, float, float, float, float)[m[K’:
[01m[K/home/ros/EENG4/AdvancedRobotics_Lab3/src/advrobotics_lab3_ros2/src/Kinematics.cpp:43:20:[m[K [01;35m[Kwarning: [m[Ksuggest parentheses around comparison in operand of ‘[01m[K|[m[K’ [[01;35m[K]8;;https://gcc.gnu.org/onlinedocs/gcc/Warning-Options.html#index-Wparentheses-Wparentheses]8;;[m[K]
   43 |         if ([01;35m[Kcos_q3 >1[m[K | cos_q3 <-1)
      |             [01;35m[K~~~~~~~^~[m[K
[ 77%] [32m[1mLinking CXX executable ik_server[0m
[ 77%] Built target ik_server
[ 88%] [32m[1mLinking CXX executable ik_client[0m
[ 88%] Built target ik_client
[100%] [32m[1mLinking CXX executable poppy_core[0m
[100%] Built target poppy_core
-- Install configuration: ""
-- Installing: /home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/lib/advrobotics_lab3_ros2/ik_server
-- Set runtime path of "/home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/lib/advrobotics_lab3_ros2/ik_server" to ""
-- Installing: /home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/lib/advrobotics_lab3_ros2/ik_client
-- Set runtime path of "/home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/lib/advrobotics_lab3_ros2/ik_client" to ""
-- Installing: /home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/lib/advrobotics_lab3_ros2/poppy_core
-- Set runtime path of "/home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/lib/advrobotics_lab3_ros2/poppy_core" to ""
-- Installing: /home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/share/ament_index/resource_index/package_run_dependencies/advrobotics_lab3_ros2
-- Installing: /home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/share/ament_index/resource_index/parent_prefix_path/advrobotics_lab3_ros2
-- Installing: /home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/share/advrobotics_lab3_ros2/environment/ament_prefix_path.sh
-- Installing: /home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/share/advrobotics_lab3_ros2/environment/ament_prefix_path.dsv
-- Installing: /home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/share/advrobotics_lab3_ros2/environment/path.sh
-- Installing: /home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/share/advrobotics_lab3_ros2/environment/path.dsv
-- Installing: /home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/share/advrobotics_lab3_ros2/local_setup.bash
-- Installing: /home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/share/advrobotics_lab3_ros2/local_setup.sh
-- Installing: /home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/share/advrobotics_lab3_ros2/local_setup.zsh
-- Installing: /home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/share/advrobotics_lab3_ros2/local_setup.dsv
-- Installing: /home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/share/advrobotics_lab3_ros2/package.dsv
-- Installing: /home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/share/ament_index/resource_index/packages/advrobotics_lab3_ros2
-- Installing: /home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/share/advrobotics_lab3_ros2/cmake/advrobotics_lab3_ros2Config.cmake
-- Installing: /home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/share/advrobotics_lab3_ros2/cmake/advrobotics_lab3_ros2Config-version.cmake
-- Installing: /home/ros/EENG4/AdvancedRobotics_Lab3/src/install/advrobotics_lab3_ros2/share/advrobotics_lab3_ros2/package.xml
