Ejemplo minimal de libfranka: Cómo consultar q (pose)

#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 {
    // Conectar al robot.
    franka::Robot robot("192.168.0.1");  // Replace with your robot's IP address.

    // Consultar e imprimir continuamente la pose del robot.
    while (true) {
      // Obtener el estado actual del robot.
      franka::RobotState state = robot.readOnce();

      // Extraer e imprimir la pose del efector final.
      // Usar ancho fijo para alinear todas las columnas
      cout << "q =" << std::fixed << std::setprecision(5);
      for (size_t i = 0; i < state.q.size(); i++)
      {
        cout << state.q.at(i) << " ";
      }
      cout << endl;
      // Añadir un pequeño retraso para evitar salida excesiva.
      std::this_thread::sleep_for(std::chrono::milliseconds(1));
    }
  } catch (const franka::Exception& ex) {
    // Manejar excepciones lanzadas por el control del robot.
    std::cerr << "Exception: " << 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
[...]