import bge # Bibliothèque Blender Game Engine (UPBGE)
import time
from rp_lib import * # Bibliothèque Ropy

###############################################################################
# rp_cmd.py
# @title: Commandes pour le Rover Ropy
# @project: Ropy (Blender-EduTech)
###############################################################################

###############################################################################
# Initialisation du niveau :
# Niveau 1 : Les premiers pas de Ropy
# Niveau 2 : Ma première fonction
# Niveau 3 : Sécuriser Ropy
# Niveau 4 : Partir au bout du monde
# Niveau 5 : Faire face à l'inconnu
# Niveau 6 : Se rendre utile
###############################################################################

###############################################################################
# Fonctions
###############################################################################

def mrp_avancer():
    rp_avancer()
    rp_marquer()

###############################################################################
# Commandes
###############################################################################

def commandes():

    # Ecrire votre code ici ...
    rp_jumeau('/dev/ttyACM1', 115200)
    rp_tempo(1)
    print (1)
    rp_tempo(1)
    print (2)
    rp_tempo(1)
    print (3)
    rp_tempo(1)
    print (4)
    

    # rp_serie_msg("Go !")
    # txt =""
    # while True:
    #     rp_tempo(0.1)
        # pass
        # txt=rp_serie_rcpt()
        # print (txt)
        # if txt !="":
        #     print (txt)
        #     break

    # rp_jumeau_config(50, 20, 90)  # (vitesse, temps_avancer, temps_rotation)
    # rp_tempo(1)
 
    # rp_gauche()
    # mrp_avancer()
    # rp_droite()
    # mrp_avancer()
    # mrp_avancer()
    # mrp_avancer()
    # mrp_avancer()
    # rp_droite()
    # mrp_avancer()
    # mrp_avancer()

    rp_jumeau_close()
    rp_fin() # A garder

###############################################################################
# En: Externals calls << DONT CHANGE THIS SECTION >>
# Fr: Appels externes << NE PAS MODIFIER CETTE SECTION >>
###############################################################################

if __name__=='start':
    thread_cmd_start(commandes)
if __name__=='stop':
    thread_cmd_stop()