05. Contrôle de position
par set_cursor_position Déplacez le curseur de « Inverse3 » vers la position souhaitée.Les modèles d'interaction varient d'une langue à l'autre.——En C++, on utilise des cibles aléatoires ponctuelles, tandis qu'en Python, on utilise des mouvements continus pilotés par le clavier.
Contenu pédagogique :
- Utilisation
set_cursor_positionMise en œuvre du contrôle en mode position - Deux modèles d'interaction différents correspondant à une même commande de base
- Limiter la cible à la sphère de l'espace de travail — le rayon utilisé parMinverse est plus petit que celui de Inverse3
- Configurer les paramètres par défautde l'espace de travail afin que le point d'origine soit situé au centre de l'espace de travail
Processus de travail
C++ (modèle à cibles aléatoires)
- Lancer un thread d'entrée en arrière-plan pour lire les frappes tamponnées ligne par ligne à partir de l'entrée standard (stdin) (
n,+,-,q). - Activer WebSocket. S'enregistrer dès la réception de la première trame de données d'état. Fichier de configuration de session, puis configurer
configure.preset: arm_front_centered。Générer la première cible aléatoire à l'intérieur de la sphère (échantillonnage par rejet, rayon de 0,08 m). - À chaque cycle, envoyer un message à la cible actuelle
set_cursor_positionCommande. Le curseur suit la cible en douceur : le serveur limite la vitesse et effectue une interpolation. - Lorsque l'utilisateur saisit
nLorsque vous appuyez sur la touche ENTRÉE, le thread de saisie génère une nouvelle cible aléatoire.+/-Régler la vitesse ;qQuitter.
Python (déplacer le modèle en maintenant le bouton enfoncé)
- Activer WebSocket. À la réception de la première trame de données d'état, vérifier
status.calibrated——Si l'appareil n'a pas encore été étalonné, un message s'affiche pour en informer l'utilisateur. - Lire
config.type, pour sélectionner le rayon de l'espace de travail (minverseest de 0,04 m, et de 0,10 m dans les autres cas). - Inscription Fichier de configuration de session, puis configurer
configure.preset: arm_front_centered。 - À chaque cycle : interroger l'état du clavier (
W/A/S/D/Q/E), en appuyant dans la direction de chaque axe sur lequel on appuieSPEEDMettre à jour la position cible, la limiter à l'intérieur de la sphère de l'espace de travail, puis envoyerset_cursor_position。Appuyez surRIl est possible de réinitialiser la cible à l'origine.
Paramètres
| Nom | Valeur par défaut (C++) | Valeur par défaut (Python) | Utilisation |
|---|---|---|---|
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 / à chaque pression sur une touche | 0.00005 m / par cycle | Pas de pas par interaction |
PRINT_EVERY_MS | — | 100 | Régulation à distance du débit (Python) |
| Fichier de configuration de session | co.haply.inverse.tutorials:position-control | Identique | À utiliser pour l'identification dans Haply Hub |
Les instances Python commencent à vérifier les données d'état à partir de la première image. status.calibrated, si l'appareil n'est pas calibré, un message d'avertissement s'affiche. La version C++ part du principe que le calibrage a déjà été effectué.
Champs d'état lus
data.inverse3[0].device_id——Utilisé pour la construction de commandesdata.inverse3[0].state.cursor_position——Données de télémesure- (Python, première image uniquement)
data.inverse3[0].config.type—— Permet de choisir entre les rayons de Inverse3 et Minverse - (Python, première image uniquement)
data.inverse3[0].status.calibrated——Si la valeur est « false », afficher un message d'avertissement à l'utilisateur
Envoyer / Recevoir
Processus de communication
- C++ Lancer un thread stdin en arrière-plan, dans lequel écrire
std::atomic<float>Valeurs cibles de type ; les threads WebSocket lisent ces valeurs à chaque cycle. EntréenLorsque vous appuyez sur ENTER, le thread de saisie génère une nouvelle cible aléatoire ; la saisieqDans ce cas, les deux threads s'arrêtent. - Python Il s'agit d'une implémentation asynchrone monothread : la boucle WebSocket interroge l'état du clavier à chaque itération et met directement à jour
position。
Le contenu de la charge de l'API inverse est identique : le premier cycle transporte le profil de session et configure.preset, les cycles suivants ne comportent que set_cursor_position。
- Python
- C++ (nlohmann)
- C++ (Glaze)
Boucle asynchrone unique. Interrogation du clavier (handle_keys) s'exécute en mode inline à chaque cycle, sans utiliser de threads.config.type et status.calibrated Elle n'est lue qu'une seule fois dans les données d'état de la première image.
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 : le thread d'arrière-plan lit stdin et écrit dans std::atomic<float> Valeur cible de type ; le thread d'E/S libhv s'exécute à chaque cycle ws.onmessage, puis lire ces variables 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);
Le même modèle à deux threads. La commande utilise des structures fortement typées —std::optional<device_configure> Enregistrer un préréglage à usage unique pour chaque appareil ; lors des cycles suivants, celui-ci sera omis du fichier JSON.
// 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);
Le tutoriel n° 05 est également installé localement avec le SDK — vous le trouverez dans le répertoire d'installation du service, sous tutorials/05-haply-inverse-position-control/ Rechercher dans.
Code source : Python · C++ · C++ Glaze
Contenu associé : Commandes de contrôle (set_cursor_position) · Montage et espace de travail (paramètres par défaut) · Type (vec3) · Tutoriel n° 6 (Combinaisons)