Share via

Link copied to clipboard

Programmation des Robots

La programmation se fait soit en Python, soit sous forme de blocs de type blockly.
L’environnement de développement est ROBO Pro Coding

ROBO Pro Coding Getting Started

$ ROBOPro

On choisit le langage de Programmation :

La Programmation se fait dans l’onglet Main Program:

L’ajout d’éléments à contrôler se fait dans l’ongle Controller Configuration:

REMARQUE : L’enregistrement et le chargement d’un programme se fait avec les commandes Import/Export :

Connection au TXT4.0 :

Le PC et le contrôleur doivent au préalable être connectés en WIFI au Réseau e021 ( mot de passe : ROBOTROSE021 ) ou b103 ( mot de passe : robotb103 )
Si nécessaire, faire apparaitre la configuration réseau en tapant nm-applet dans un terminal.

Côté PC, vérifier que ce dernier a bien une adresse IP en 192.168.50.x, pour cela taper ifconfig ou ipaddr dans un terminal.
Côté TXT4.0, dans le menu principal, aller dans Info–>WiFi et noter l’adresse IP 192.168.50.y

Dans RoboPro, Cliquer sur Connect Controller :

Renseigner l’ API Code ( disponible dans le TXT4.0 : Paramètres –> Clé API ), et remplacer txt40.local par l’adresse 192.168.50.y

Ajout et initialisation d’une Variable

Pour créer une nouvelle variable, aller dans Variables –> Create Variable…

Initialisation de la variable :

Contrôle d’un Moteur en Boucle Fermée

Ajouter un Encodermotor dans Controller Configuration :

#! /usr/bin/python3

import fischertechnik.factories as txt_factory

txt_factory.init()
txt_factory.init_motor_factory()
txt_factory.init_counter_factory()

TXT_M = txt_factory.controller_factory.create_graphical_controller()
TXT_M_M1_encodermotor = txt_factory.motor_factory.create_encodermotor(TXT_M, 1)
TXT_M_C1_motor_step_counter = txt_factory.counter_factory.create_encodermotor_counter(TXT_M, 1)
TXT_M_C1_motor_step_counter.set_motor(TXT_M_M1_encodermotor)

txt_factory.initialized()

Puis ajouter les blocs suivants dans la fenêtre Main Program :

CW/CCW = Clockwise, CounterClockWise

#! /usr/bin/python3

import time
from fischertechnik.controller.Motor import Motor
from lib.controller import *

while True:
    TXT_M_M1_encodermotor.set_speed(int(512), Motor.CCW)
    TXT_M_M1_encodermotor.start_sync()
time.sleep(0.5)

Dans le cas d’une commande de 2 moteurs, afin d’éviter tout décalage de vitesse d’un moteur par rapport à l’autre, il est nécessaire d’ajouter l’option synchronisation :

import fischertechnik.factories as txt_factory

txt_factory.init()
txt_factory.init_motor_factory()
txt_factory.init_counter_factory()

TXT_M = txt_factory.controller_factory.create_graphical_controller()
TXT_M_M1_encodermotor = txt_factory.motor_factory.create_encodermotor(TXT_M, 1)
TXT_M_M2_encodermotor = txt_factory.motor_factory.create_encodermotor(TXT_M, 2)
TXT_M_C1_motor_step_counter = txt_factory.counter_factory.create_encodermotor_counter(TXT_M, 1)
TXT_M_C1_motor_step_counter.set_motor(TXT_M_M1_encodermotor)
TXT_M_C2_motor_step_counter = txt_factory.counter_factory.create_encodermotor_counter(TXT_M, 2)
TXT_M_C2_motor_step_counter.set_motor(TXT_M_M2_encodermotor)

txt_factory.initialized()

#! /usr/bin/python3
import time
from fischertechnik.controller.Motor import Motor
from lib.controller import *

speed = None

speed = 500
TXT_M_M1_encodermotor.set_speed(int(speed), Motor.CW)
TXT_M_M2_encodermotor.set_speed(int(speed), Motor.CW)
TXT_M_M1_encodermotor.start_sync(TXT_M_M2_encodermotor)
time.sleep(500)

Vérification des entrées sorties avec Interface Test

Il est possible de vérifier le bon fonctionnement des différents éléments branchés sur le contrôleur avec Interface Test :

Mesure avec le capteur US et Affichage d’une distance sur l’écran LCD

Ajouter la fenêtre Display Configuration si elle n’est pas présente :

Dans la fenêtre Display Configuration, ajouter un Label, avec comme nom txt_label

Fenêtre Controller Configuration :

import fischertechnik.factories as txt_factory

txt_factory.init()
txt_factory.init_input_factory()

TXT_M = txt_factory.controller_factory.create_graphical_controller()
TXT_M_I1_ultrasonic_distance_meter = txt_factory.input_factory.create_ultrasonic_distance_meter(TXT_M, 1)

txt_factory.initialized()

Fenêtre Main Program :

import time
from lib.controller import *
from lib.display import *

while True:
    display.set_attr("txt_label.text", str(TXT_M_I1_ultrasonic_distance_meter.get_distance()))
    time.sleep(0.5)

Architecture

Communication MQTT

Automatique-robotique