05. Contrôle de position
Déplace le Inverse3 vers une position cible via set_cursor_position. Le modèle d'interaction varie selon la langue — Le C++ utilise des cibles aléatoires ponctuelles, tandis que Python utilise un déplacement continu commandé par le clavier.
Ce que vous apprendrez :
- Utilisation de
set_cursor_positionpour la régulation en mode position - Deux modèles d'interaction différents pour une même commande sous-jacente
- Fixation de la cible sur une sphère de l'espace de travail — Minverse un rayon plus petit qu'Inverse3
- Définir un préréglage d'espace de travail pour que l'origine se trouve au centre de l'espace de travail
Flux de travail
C++ (modèle à cible aléatoire)
- Lancer un thread d'entrée en arrière-plan qui lit les frappes stockées dans le tampon de ligne (
n,+,-,q) à partir de l'entrée standard. - Ouvrez le WebSocket. Lors de la première trame d'état, enregistrez le profil de session et définir
configure.preset: arm_front_centered. Générer la première cible aléatoire à l'intérieur d'une sphère (échantillonnage par rejet, rayon de 0,08 m). - À chaque tick, envoyer un
set_cursor_positioncommande vers la cible actuelle. Le curseur la suit en douceur : le service applique une limitation de débit et effectue une interpolation. - Lorsque l'utilisateur tape
n+ ENTRÉE : le thread d'entrée génère une nouvelle cible aléatoire.+/-régler la vitesse ;qquitte.
Python (modèle « tenir pour déplacer »)
- Ouvrez le WebSocket. Dans la première trame d'état, vérifiez
status.calibrated— demander à l'utilisateur de procéder au calibrage si l'appareil n'est pas encore calibré. - Lire
config.typepour choisir le rayon de l'espace de travail (minverse= 0,04 m, sinon = 0,10 m). - Enregistrer le profil de session et définir
configure.preset: arm_front_centered. - À chaque itération : vérifier l'état du clavier (
W/A/S/D/Q/E), mettre à jour la position cible enSPEEDle long de chaque axe enfoncé, fixer à la sphère de travail, puis envoyerset_cursor_position.Rréinitialise la cible à l'origine.
Paramètres
| Nom | Par défaut (C++) | Par défaut (Python) | Objectif |
|---|---|---|---|
workspace_radius / RADIUS_INVERSE3 | 0.08 m | 0.10 m (Inverse3) / 0.04 m (Minverse) | Rayon de la sphère cible |
speed_step / SPEED | 0.01 / presse | 0.00005 m / tick | Étape par interaction |
PRINT_EVERY_MS | — | 100 | Accélérateur de télémétrie (Python) |
| Profil de session | co.haply.inverse.tutorials:position-control | idem | Identifie dans Haply |
Les vérifications de la variante Python status.calibrated à partir du premier cadre d'état et demande à l'utilisateur de procéder à l'étalonnage si l'appareil n'est pas encore étalonné. La variante C++ part du principe que l'étalonnage est déjà terminé.
Champs d'état lus
data.inverse3[0].device_id— pour la création de la commandedata.inverse3[0].state.cursor_position— télémétrie- (Python, première image uniquement)
data.inverse3[0].config.type— sélectionne Minverse « Inverse3 Minverse - (Python, première image uniquement)
data.inverse3[0].status.calibrated— demande à l'utilisateur si la valeur est fausse
Envoyer / recevoir
Processus de communication
- C++ exécute un thread stdin en arrière-plan qui écrit
std::atomic<float>cibles ; le thread WebSocket les lit à chaque tick. Surn+ ENTER : le thread de saisie génère une nouvelle cible aléatoire ; surq, les deux fils ont été fermés. - Python fonctionne en asynchrone à un seul thread : la boucle WebSocket interroge l'état du clavier à chaque itération et met à jour
positiondirectement.
Les charges utiles de l'API inverse sont identiques : le premier tick contient le profil de session + configure.preset, les ticks suivants ne portent que set_cursor_position.
- Python
- C++ (nlohmann)
- C++ (Glaze)
Boucle asynchrone unique. Interrogation du clavier (handle_keys) s'exécute en ligne à chaque itération — sans threads. config.type et status.calibrated sont lues une seule fois à partir de la première trame d'état.
async with websockets.connect(URI) as websocket:
while True:
msg = await websocket.recv()
data = json.loads(msg)
if first_message:
first_message = False
device_id = data["inverse3"][0]["device_id"]
radius = get_workspace_radius(data["inverse3"][0].get("config", {}))
# Handshake: profile + preset (one-shot)
request_msg = {
"session": {"configure": {"profile": {"name": SLUG}}},
"inverse3": [{
"device_id": device_id,
"configure": {"preset": {"preset": "arm_front_centered"}},
}],
}
else:
# Per tick: update position from keyboard (classic polling, not shown), send command
position = handle_keys(position, radius)
request_msg = {
"inverse3": [{
"device_id": device_id,
"commands": {"set_cursor_position": {"position": position}},
}],
}
await websocket.send(json.dumps(request_msg))
Modèle à deux threads : un thread d'arrière-plan lit le flux d'entrée standard et écrit std::atomic<float> cibles ; le thread d'E/S de libhv s'exécute ws.onmessage à chaque tick et lit les valeurs atomiques.
// Shared state written by the stdin thread, read by the ws thread
static std::atomic<float> target_x{0.0f}, target_y{0.0f}, target_z{0.0f};
ws.onmessage = [&](const std::string &message) {
const json data = json::parse(message);
if (data["inverse3"].empty()) return;
json request = {};
const bool do_handshake = first_message.exchange(false);
if (do_handshake) {
request["session"] = {{"configure", {{"profile",
{{"name", "co.haply.inverse.tutorials:position-control"}}}}}};
generate_random_target();
}
request["inverse3"] = json::array();
for (auto &el : data["inverse3"].items()) {
json dev = {
{"device_id", el.value()["device_id"]},
{"commands", {{"set_cursor_position",
{{"position", {{"x", target_x.load()},
{"y", target_y.load()},
{"z", target_z.load()}}}}}}},
};
if (do_handshake)
dev["configure"] = {{"preset", {{"preset", "arm_front_centered"}}}};
request["inverse3"].push_back(dev);
}
ws.send(request.dump());
};
ws.open("ws://localhost:10001");
std::thread input_thr(input_thread_func); // stdin reader — writes target atomics
while (running) std::this_thread::sleep_for(100ms);
Même modèle à deux threads. Structures typées pour la commande — std::optional<device_configure> contient le préréglage unique par appareil ; omis du fichier JSON lors des ticks suivants.
// Struct models
struct vec3 { float x{}, y{}, z{}; };
struct set_cursor_position_cmd { vec3 position; };
struct preset_cfg { std::string preset; };
struct device_configure { std::optional<preset_cfg> preset; };
struct device_commands {
std::string device_id;
std::optional<device_configure> configure; // one-shot
struct commands_t {
std::optional<set_cursor_position_cmd> set_cursor_position;
} commands;
};
struct commands_message {
std::optional<session_cmd> session; // one-shot
std::vector<device_commands> inverse3;
};
// Send / receive
ws.onmessage = [&](const std::string &msg) {
devices_message data{};
if (glz::read<glz_settings>(data, msg)) return;
commands_message request;
const bool do_handshake = first_message.exchange(false);
if (do_handshake) {
request.session = session_cmd{ /* profile = position-control */ };
}
for (const auto &dev : data.inverse3) {
device_commands dc{ .device_id = dev.device_id };
dc.commands.set_cursor_position = set_cursor_position_cmd{
.position = {target_x.load(), target_y.load(), target_z.load()}};
if (do_handshake)
dc.configure = device_configure{ .preset = preset_cfg{"arm_front_centered"} };
request.inverse3.push_back(std::move(dc));
}
std::string out;
(void)glz::write_json(request, out);
ws.send(out);
};
ws.open("ws://localhost:10001");
std::thread input_thr(input_thread_func);
while (running) std::this_thread::sleep_for(100ms);
Source : Python · C++ · C++ Glaze
À lire également : Commandes de contrôle (set_cursor_position) · Montage et espace de travail (préréglages) · Types (vec3) · Tutoriel 06 (Combiné)