libfranka мінімальний приклад: Як отримати q (позу)

#include <franka/robot.h>
#include <franka/robot_state.h>
#include <franka/exception.h>
#include <iostream>
#include <array>
#include <chrono>
#include <iostream>
#include <thread>
#include <iomanip>

using std::cout, std::endl;

int main() {
  try {
    // Підключитися до робота.
    franka::Robot robot("192.168.0.1");  // Замініть на IP-адресу вашого робота.

    // Безперервно запитувати та виводити позу робота.
    while (true) {
      // Отримати поточний стан робота.
      franka::RobotState state = robot.readOnce();

      // Витягнути та вивести позу кінцевого виконавчого органу.
      // Використати фіксовану ширину для вирівнювання всіх стовпців
      cout << "q =" << std::fixed << std::setprecision(5);
      for (size_t i = 0; i < state.q.size(); i++)
      {
        cout << state.q.at(i) << " ";
      }
      cout << endl;
      // Додати невелику затримку, щоб уникнути надмірного виводу.
      std::this_thread::sleep_for(std::chrono::milliseconds(1));
    }
  } catch (const franka::Exception& ex) {
    // Обробити винятки, створені керуванням робота.
    std::cerr << "Виняток: " << ex.what() << std::endl;
    return -1;
  }

  return 0;
}

g++ -o franka_q franka_q.cpp -lfranka

./franka_q

q =-0.04501 -0.75216 -0.01165 -2.35292 -0.07323 1.57705 0.79462
[...]