IdentifiantMot de passe
Loading...
Mot de passe oublié ?Je m'inscris ! (gratuit)
Navigation

Inscrivez-vous gratuitement
pour pouvoir participer, suivre les réponses en temps réel, voter pour les messages, poser vos propres questions et recevoir la newsletter

Python Discussion :

Deplacement d'un robot avec Raspberry Pi 3 et Python 2.7 [Python 2.X]


Sujet :

Python

Vue hybride

Message précédent Message précédent   Message suivant Message suivant
  1. #1
    Nouveau membre du Club
    Femme Profil pro
    Étudiant
    Inscrit en
    Février 2018
    Messages
    6
    Détails du profil
    Informations personnelles :
    Sexe : Femme
    Localisation : France, Haute Garonne (Midi Pyrénées)

    Informations professionnelles :
    Activité : Étudiant

    Informations forums :
    Inscription : Février 2018
    Messages : 6
    Par défaut Deplacement d'un robot avec Raspberry Pi 3 et Python 2.7
    Bonjour,

    Je suis novice sur python et raspberry. Cela fait deux semaines que je tente d'apprendre et de développer mon projet personnel. Mon projet est un robot qui se déplace en évitant les obstacles et, lorsqu'il rentre une personne, celui ci réagit en bougeant la tête.

    J'ai utilisé un code de base pour mes moteurs pas à pas. J'utilise un shield pour gérer mes deux moteurs ensembles (https://www.gotronic.fr/art-commande...-pas-25667.htm).
    Voici le code :
    Code : Sélectionner tout - Visualiser dans une fenêtre à part
    1
    2
    3
    4
    5
    6
    7
    8
    9
    10
    11
    12
    13
    14
    15
    16
    17
    18
    19
    20
    21
    22
    23
    24
    25
    26
    27
    28
    29
    30
    31
    32
    33
    34
    35
    36
    37
    38
    39
    40
    41
    42
    43
    44
    45
    46
    47
    48
    49
    50
    51
    52
    53
    54
    55
    56
    57
    58
    59
    60
    61
    62
    63
    64
    65
    66
    67
    68
    69
    70
    71
    72
    73
    74
    75
    76
    77
    78
    79
    80
    81
    82
    83
    84
    85
    86
    87
    88
    89
    90
    91
    92
    93
    94
    95
    96
    97
     
    # coding=utf-8
    import RPi.GPIO as GPIO
    import time
    import sys
     
    GPIO.setwarnings(False)
    GPIO.setmode(GPIO.BOARD)
     
    # définition des variables
    pin1=11
    pin2=12
    pin3=13
    pin4=15
     
    pin5=16
    pin6=18
    pin7=22
    pin8=7
     
    # définition des broches
    GPIO.setup(pin1,GPIO.OUT)
    GPIO.setup(pin2,GPIO.OUT)
    GPIO.setup(pin3,GPIO.OUT)
    GPIO.setup(pin4,GPIO.OUT)
     
    GPIO.setup(pin5,GPIO.OUT)
    GPIO.setup(pin6,GPIO.OUT)
    GPIO.setup(pin7,GPIO.OUT)
    GPIO.setup(pin8,GPIO.OUT)
     
    # définition des variables
    Apin1=[0,1,0,0,1]
    Apin2=[0,1,1,0,0]
    Apin3=[0,0,1,1,0]
    Apin4=[0,0,0,1,1]
    Apin5=[0,1,0,0,1]
    Apin6=[0,1,1,0,0]
    Apin7=[0,0,1,1,0]
    Apin8=[0,0,0,1,1]
    current=0
    target=0
     
    print("Programme test Moto2 [Appuyez sur Ctrl + C pour terminer le test]")
     
    # définition de la fonction
    def GO_THERE(target,current):
        if current<target:
            while current<target:
                i=current&2 + 1
                GPIO.output(pin1,Apin1[-i])
                GPIO.output(pin2,Apin2[-i])
                GPIO.output(pin3,Apin3[-i])
                GPIO.output(pin4,Apin4[-i])        
                GPIO.output(pin5,Apin5[i])
                GPIO.output(pin6,Apin6[i])
                GPIO.output(pin7,Apin7[i])
                GPIO.output(pin8,Apin8[i])
                time.sleep(.003)
                current= current + 1
        else:
            while current>target:
                 i=current&2 + 1
                 GPIO.output(pin1,Apin1[-i])
                 GPIO.output(pin2,Apin2[-i])
                 GPIO.output(pin3,Apin3[-i])
                 GPIO.output(pin4,Apin4[-i])
                 GPIO.output(pin5,Apin5[i])
                 GPIO.output(pin6,Apin6[i])
                 GPIO.output(pin7,Apin7[i])
                 GPIO.output(pin8,Apin8[i])             
                 time.sleep(.003)
                 current= current - 1
        print(current,target)
        return current;
     
    # programme principal
    try:
        while True:
            target=800
            current=GO_THERE(target,current)
     
            time.sleep(2)
            target=0
            current=GO_THERE(target,current)
     
            time.sleep(2)
            target=900
            current=GO_THERE(target,current)
     
            time.sleep(2)
            target=0
            current=GO_THERE(target,current)
     
    # remise en place de tous les GPIO
    except KeyboardInterrupt:
        GPIO.cleanup()

    Maintenant j'ai tenté de modifier le code en le personnalisant pour en faire les définitions, mais la les moteurs ne tournent plus ... Je ne vois pas où est le problème, j'ai du mal noter quelque chose mais étant novice je ne vois pas ... Avec vous une idée ?
    Code : Sélectionner tout - Visualiser dans une fenêtre à part
    1
    2
    3
    4
    5
    6
    7
    8
    9
    10
    11
    12
    13
    14
    15
    16
    17
    18
    19
    20
    21
    22
    23
    24
    25
    26
    27
    28
    29
    30
    31
    32
    33
    34
    35
    36
    37
    38
    39
    40
    41
    42
    43
    44
    45
    46
    47
    48
    49
    50
    51
    52
    53
    54
    55
    56
    57
    58
    59
    60
    61
    62
    63
    64
    65
    66
    67
    68
    69
    70
    71
    72
    73
    74
    75
    76
    77
    78
    79
    80
    81
    82
    83
    84
    85
    86
    87
    88
    89
    90
    91
    92
    93
    94
    95
    96
    97
    98
    99
    100
    101
    102
    103
    104
    105
    106
    107
    108
    109
    110
    111
    112
    113
    114
    115
    116
    117
    118
    119
    120
    121
    122
    123
    124
    125
    126
    127
    128
    129
    130
    131
    132
    133
    134
    135
    136
    137
    138
    139
    140
    141
    142
    143
    144
    145
    146
    147
    148
    149
    150
    151
    152
    153
    154
    155
    156
    157
    158
    159
    160
    161
    162
    163
    164
    165
    166
    167
    168
    169
    170
    171
    172
    173
    174
    175
    176
    177
    178
    179
    180
    181
    182
    183
    184
    185
    186
    187
    188
     
    import RPi.GPIO as GPIO
    import time
    import sys
     
    GPIO.setwarnings(False)
    GPIO.setmode(GPIO.BOARD)
     
    # définition des variables
    pin1=11
    pin2=12
    pin3=13
    pin4=15
     
    pin5=16
    pin6=18
    pin7=22
    pin8=7
     
    #GPIO_TRIGGER = 38
    #GPIO_ECHO = 40
     
    # définition des broches
    GPIO.setup(pin1,GPIO.OUT)
    GPIO.setup(pin2,GPIO.OUT)
    GPIO.setup(pin3,GPIO.OUT)
    GPIO.setup(pin4,GPIO.OUT)
     
    GPIO.setup(pin5,GPIO.OUT)
    GPIO.setup(pin6,GPIO.OUT)
    GPIO.setup(pin7,GPIO.OUT)
    GPIO.setup(pin8,GPIO.OUT)
     
    #GPIO.setup(GPIO_TRIGGER, GPIO.OUT)
    #GPIO.setup(GPIO_ECHO, GPIO.IN)
     
    # définition des variables
    Apin1=[0,1,0,0,1]
    Apin2=[0,1,1,0,0]
    Apin3=[0,0,1,1,0]
    Apin4=[0,0,0,1,1]
    Apin5=[0,1,0,0,1]
    Apin6=[0,1,1,0,0]
    Apin7=[0,0,1,1,0]
    Apin8=[0,0,0,1,1]
     
    position=0
    #Avancer=0
    #Reculer=0
    #AvancerDroite=0
    #AvancerGauche=0
    #ReculerDroite=0
    #ReculerGauche=0
     
    #def distance():
     
    #    GPIO.output(GPIO_TRIGGER, True)
    #    time.sleep(0.00001)
    #    GPIO.output(GPIO_TRIGGER, False)
     
    #    StartTime = time.time()
    #    StopTime = time.time()
     
    #    while GPIO.input(GPIO_ECHO) == 0:
    #        StartTime = time.time()
    #    while GPIO.input(GPIO_ECHO) == 1:
    #        StopTime = time.time()
     
    #    TimeElapsed = StopTime - StartTime
    #    distance = (TimeElapsed * 34300) / 2 
    #    return distance
     
    def Avancer(position):
        print("avancer")
        i=position&2 + 1
        GPIO.output(pin1,Apin1[-i])
        GPIO.output(pin2,Apin2[-i])
        GPIO.output(pin3,Apin3[-i])
        GPIO.output(pin4,Apin4[-i])        
        GPIO.output(pin5,Apin5[i])
        GPIO.output(pin6,Apin6[i])
        GPIO.output(pin7,Apin7[i])
        GPIO.output(pin8,Apin8[i])
        time.sleep(.003)
        position= position + 1
        return position
     
    def AvancerDroite(position):
        print("avancer droite")
        i=position&2 + 1
        GPIO.output(pin1,Apin1[i])
        GPIO.output(pin2,Apin2[i])
        GPIO.output(pin3,Apin3[i])
        GPIO.output(pin4,Apin4[i])        
        GPIO.output(pin5,Apin5[i])
        GPIO.output(pin6,Apin6[i])
        GPIO.output(pin7,Apin7[i])
        GPIO.output(pin8,Apin8[i])
        time.sleep(.003)
        position= position + 1
        return position
     
    def AvancerGauche(position):
        print("avancer gauche")
        i=position&2 + 1
        GPIO.output(pin1,Apin1[i])
        GPIO.output(pin2,Apin2[i])
        GPIO.output(pin3,Apin3[i])
        GPIO.output(pin4,Apin4[i])        
        GPIO.output(pin5,Apin5[i])
        GPIO.output(pin6,Apin6[i])
        GPIO.output(pin7,Apin7[i])
        GPIO.output(pin8,Apin8[i])
        time.sleep(.003)
        position= position - 1
        return position
     
    def Reculer(position):
        print("reculer")
        i=position&2 + 1
        GPIO.output(pin1,Apin1[-i])
        GPIO.output(pin2,Apin2[-i])
        GPIO.output(pin3,Apin3[-i])
        GPIO.output(pin4,Apin4[-i])
        GPIO.output(pin5,Apin5[i])
        GPIO.output(pin6,Apin6[i])
        GPIO.output(pin7,Apin7[i])
        GPIO.output(pin8,Apin8[i])             
        time.sleep(.003)
        position = position - 1
        return position
     
    def ReculerDroite(position):
        print("reculer droite")
        i=position&2 + 1
        GPIO.output(pin1,Apin1[-i])
        GPIO.output(pin2,Apin2[-i])
        GPIO.output(pin3,Apin3[-i])
        GPIO.output(pin4,Apin4[-i])        
        GPIO.output(pin5,Apin5[-i])
        GPIO.output(pin6,Apin6[-i])
        GPIO.output(pin7,Apin7[-i])
        GPIO.output(pin8,Apin8[-i])
        time.sleep(.003)
        position= position + 1
        return position
     
    def ReculerGauche(position):
        print("reculer gauche")
        i=position&2 + 1
        GPIO.output(pin1,Apin1[-i])
        GPIO.output(pin2,Apin2[-i])
        GPIO.output(pin3,Apin3[-i])
        GPIO.output(pin4,Apin4[-i])        
        GPIO.output(pin5,Apin5[-i])
        GPIO.output(pin6,Apin6[-i])
        GPIO.output(pin7,Apin7[-i])
        GPIO.output(pin8,Apin8[-i])
        time.sleep(.003)
        position= position - 1
        return position
     
    # programme principal
    try:
      while True:     
        #dist = distance()
        #print ("%.1f cm" % dist)
        print (position)
     
        #if(dist<= 5):
        Reculer(position)        
        time.sleep(2)
        ReculerDroite(position)        
        time.sleep(2)     
        ReculerGauche(position)        
        time.sleep(2) 
     
        #else:
        Avancer(position)        
        time.sleep(2)
        AvancerDroite(position)        
        time.sleep(2)     
        AvancerGauche(position)        
        time.sleep(2)        
     
    # remise en place de tous les GPIO
    except KeyboardInterrupt:
        GPIO.cleanup()

  2. #2
    Expert éminent
    Homme Profil pro
    Architecte technique retraité
    Inscrit en
    Juin 2008
    Messages
    21 743
    Détails du profil
    Informations personnelles :
    Sexe : Homme
    Localisation : France, Manche (Basse Normandie)

    Informations professionnelles :
    Activité : Architecte technique retraité
    Secteur : Industrie

    Informations forums :
    Inscription : Juin 2008
    Messages : 21 743
    Par défaut
    Salut,

    Citation Envoyé par Axaya Voir le message
    Maintenant j'ai tenté de modifier le code en le personnalisant pour en faire les définitions, mais la les moteurs ne tournent plus ... Je ne vois pas où est le problème, j'ai du mal noter quelque chose mais étant novice je ne vois pas ... Avec vous une idée ?
    Comme pas grand monde dispose du matériel, il n'y a que vous pour apprécier de combien se déplace un moteur lorsqu'on exécute qu'une seule fois la séquence d'instructions:
    Code : Sélectionner tout - Visualiser dans une fenêtre à part
    1
    2
    3
    4
    GPIO.output(pin1,Apin1[i])
    GPIO.output(pin2,Apin2[i])
    GPIO.output(pin3,Apin3[i])
    GPIO.output(pin4,Apin4[i])
    puis vérifier que chacune des opérations élémentaires que vous avez programmé fonctionne et savoir ce qu'on doit attendre de la séquence de déplacements programmée alors que "position" n'est pas mis à jour.

    - W
    Architectures post-modernes.
    Python sur DVP c'est aussi des FAQs, des cours et tutoriels

  3. #3
    Expert confirmé

    Homme Profil pro
    Inscrit en
    Octobre 2008
    Messages
    4 307
    Détails du profil
    Informations personnelles :
    Sexe : Homme
    Localisation : Belgique

    Informations forums :
    Inscription : Octobre 2008
    Messages : 4 307
    Par défaut
    Salut,

    Je ne sais pas si c'est cela mais ta position est toujours zéro.

    Tes fonctions de déplacement modifie la position, logique. Mais tu ne te préoccupes pas de récupérer la nouvelle position.

    Il faut donc faire pour toutes tes commandes:
    Code : Sélectionner tout - Visualiser dans une fenêtre à part
    1
    2
    3
    4
    5
     
        position = Reculer(position)        
        time.sleep(2)
        position = ReculerDroite(position)
        etc ...
    Je n'ai pas tout regardé, hein.

  4. #4
    Nouveau membre du Club
    Femme Profil pro
    Étudiant
    Inscrit en
    Février 2018
    Messages
    6
    Détails du profil
    Informations personnelles :
    Sexe : Femme
    Localisation : France, Haute Garonne (Midi Pyrénées)

    Informations professionnelles :
    Activité : Étudiant

    Informations forums :
    Inscription : Février 2018
    Messages : 6
    Par défaut
    J'ai testé tout les paramètres [i] et [-i] sur le code que j'ai pris en exemple et tout fonctionnait mais en lui donnant une "target" donc un objectif de déplacement... Cependant, je sais que les [i] et [-i] sont justes.

    En effet, en faisant un "print" de ma position je vois qu'elle est toujours à 0, il n'avance donc pas. Cependant je pensais que faire ou permettrait de le faire avancer de 1 "tour", mais non. Même en remplaçant le +1 par +5 rien ne se passe et la position est parfois à -4 sans que les moteurs s'activent...
    J'ai également changé en notant :
    Code : Sélectionner tout - Visualiser dans une fenêtre à part
    1
    2
    3
    4
    5
     
    position = Reculer(position)        
    time.sleep(2)
    position = ReculerDroite(position)
    etc ...
    mais sans succès

  5. #5
    Nouveau membre du Club
    Femme Profil pro
    Étudiant
    Inscrit en
    Février 2018
    Messages
    6
    Détails du profil
    Informations personnelles :
    Sexe : Femme
    Localisation : France, Haute Garonne (Midi Pyrénées)

    Informations professionnelles :
    Activité : Étudiant

    Informations forums :
    Inscription : Février 2018
    Messages : 6
    Par défaut
    Le code seul ne fonctionne pas :
    Code : Sélectionner tout - Visualiser dans une fenêtre à part
    1
    2
    3
    4
    5
    6
     
    position=position&2 +1
    GPIO.output(pin1,Apin1[i])
    GPIO.output(pin2,Apin2[i])
    GPIO.output(pin3,Apin3[i])
    GPIO.output(pin4,Apin4[i])
    Donc je ne sais pas comment lui donner une cible sans définir un nombre de tour exacte, sachant que je souhaite qu'il avance sans s'arrêter lorsqu'il ne rencontre aucun objet.
    Je suis désolé si cela n'est pas très clair mais je tente d'expliquer autant que je peux étant donné mes faibles connaissances... ^^

  6. #6
    Expert éminent
    Homme Profil pro
    Architecte technique retraité
    Inscrit en
    Juin 2008
    Messages
    21 743
    Détails du profil
    Informations personnelles :
    Sexe : Homme
    Localisation : France, Manche (Basse Normandie)

    Informations professionnelles :
    Activité : Architecte technique retraité
    Secteur : Industrie

    Informations forums :
    Inscription : Juin 2008
    Messages : 21 743
    Par défaut
    Citation Envoyé par Axaya Voir le message
    Donc je ne sais pas comment lui donner une cible sans définir un nombre de tour exacte, sachant que je souhaite qu'il avance sans s'arrêter lorsqu'il ne rencontre aucun objet.
    Une boucle infinie comme:
    Code : Sélectionner tout - Visualiser dans une fenêtre à part
    1
    2
    3
    4
    while True:
           i = position&2 +1
           ...
           position += 1
    devrait faire tourner les roues indéfiniment.
    Elles vont patiner lorsqu'il y aura un obstacle sauf à le détecter plus intelligemment pour le contourner.

    - W
    Architectures post-modernes.
    Python sur DVP c'est aussi des FAQs, des cours et tutoriels

  7. #7
    Nouveau membre du Club
    Femme Profil pro
    Étudiant
    Inscrit en
    Février 2018
    Messages
    6
    Détails du profil
    Informations personnelles :
    Sexe : Femme
    Localisation : France, Haute Garonne (Midi Pyrénées)

    Informations professionnelles :
    Activité : Étudiant

    Informations forums :
    Inscription : Février 2018
    Messages : 6
    Par défaut
    Merci Wiztricks, c'est pour ça que je souhaitais faire des événements (def) pour pouvoir interagir avec un ultrason (qui gérera l'emplacement des obstacles).
    Bon, la position n'est plus que à 0, mais elle ne fait qu'augmenter et pas diminuer, et toujours aucun effet sur l'avancée des roues ... --

    Code : Sélectionner tout - Visualiser dans une fenêtre à part
    1
    2
    3
    4
    5
    6
    7
    8
    9
    10
    11
    12
    13
    14
    15
    16
    17
    18
    19
    20
    21
    22
    23
    24
    25
    26
    27
    28
    29
    30
    31
    32
    33
    34
    35
    36
    37
    38
    39
    40
    41
    42
    43
    44
    45
    46
    47
    48
    49
    50
    51
    52
    53
    54
    55
    56
    57
    58
    59
    60
    61
    62
    63
    64
    65
    66
    67
    68
    69
    70
    71
    72
    73
    74
    75
    76
    77
    78
    79
    80
    81
    82
    83
    84
    85
    86
    87
    88
    89
    90
    91
    92
    93
    94
    95
    96
    97
    98
    99
    100
    101
    102
    103
    104
    105
    106
    107
    108
    109
    110
    111
    112
    113
    114
    115
    116
    117
    118
    119
    120
    121
    122
    123
    124
    125
    126
    127
    128
    129
    130
    131
    132
    133
    134
    135
    136
    137
    138
    139
    140
    141
    142
    143
    144
    145
    146
    147
    148
    149
    150
    151
    152
    153
    154
    155
    156
    157
    158
    159
    160
    161
    162
    163
    164
    165
    166
    167
    168
    169
    170
    171
    172
    173
    174
    175
    176
    177
    178
    179
    180
    181
    182
    183
    184
    185
    186
    187
    188
     
    import RPi.GPIO as GPIO
    import time
    import sys
     
    GPIO.setwarnings(False)
    GPIO.setmode(GPIO.BOARD)
     
    # définition des variables
    pin1=11
    pin2=12
    pin3=13
    pin4=15
     
    pin5=16
    pin6=18
    pin7=22
    pin8=7
     
    #GPIO_TRIGGER = 38
    #GPIO_ECHO = 40
     
    # définition des broches
    GPIO.setup(pin1,GPIO.OUT)
    GPIO.setup(pin2,GPIO.OUT)
    GPIO.setup(pin3,GPIO.OUT)
    GPIO.setup(pin4,GPIO.OUT)
     
    GPIO.setup(pin5,GPIO.OUT)
    GPIO.setup(pin6,GPIO.OUT)
    GPIO.setup(pin7,GPIO.OUT)
    GPIO.setup(pin8,GPIO.OUT)
     
    #GPIO.setup(GPIO_TRIGGER, GPIO.OUT)
    #GPIO.setup(GPIO_ECHO, GPIO.IN)
     
    # définition des variables
    Apin1=[0,1,0,0,1]
    Apin2=[0,1,1,0,0]
    Apin3=[0,0,1,1,0]
    Apin4=[0,0,0,1,1]
    Apin5=[0,1,0,0,1]
    Apin6=[0,1,1,0,0]
    Apin7=[0,0,1,1,0]
    Apin8=[0,0,0,1,1]
     
    position=0
    #Avancer=0
    #Reculer=0
    #AvancerDroite=0
    #AvancerGauche=0
    #ReculerDroite=0
    #ReculerGauche=0
     
    #def distance():
     
    #    GPIO.output(GPIO_TRIGGER, True)
    #    time.sleep(0.00001)
    #    GPIO.output(GPIO_TRIGGER, False)
     
    #    StartTime = time.time()
    #    StopTime = time.time()
     
    #    while GPIO.input(GPIO_ECHO) == 0:
    #        StartTime = time.time()
    #    while GPIO.input(GPIO_ECHO) == 1:
    #        StopTime = time.time()
     
    #    TimeElapsed = StopTime - StartTime
    #    distance = (TimeElapsed * 34300) / 2 
    #    return distance
     
    def Avancer(position):
        print("avancer")
        i=position&2 + 1
        GPIO.output(pin1,Apin1[-i])
        GPIO.output(pin2,Apin2[-i])
        GPIO.output(pin3,Apin3[-i])
        GPIO.output(pin4,Apin4[-i])        
        GPIO.output(pin5,Apin5[i])
        GPIO.output(pin6,Apin6[i])
        GPIO.output(pin7,Apin7[i])
        GPIO.output(pin8,Apin8[i])
        time.sleep(.003)
        position =+ 1
        return position
     
    def AvancerDroite(position):
        print("avancer droite")
        i=position&2 + 1
        GPIO.output(pin1,Apin1[i])
        GPIO.output(pin2,Apin2[i])
        GPIO.output(pin3,Apin3[i])
        GPIO.output(pin4,Apin4[i])        
        GPIO.output(pin5,Apin5[i])
        GPIO.output(pin6,Apin6[i])
        GPIO.output(pin7,Apin7[i])
        GPIO.output(pin8,Apin8[i])
        time.sleep(.003)
        position =+ 1
        return position
     
    def AvancerGauche(position):
        print("avancer gauche")
        i=position&2 + 1
        GPIO.output(pin1,Apin1[i])
        GPIO.output(pin2,Apin2[i])
        GPIO.output(pin3,Apin3[i])
        GPIO.output(pin4,Apin4[i])        
        GPIO.output(pin5,Apin5[i])
        GPIO.output(pin6,Apin6[i])
        GPIO.output(pin7,Apin7[i])
        GPIO.output(pin8,Apin8[i])
        time.sleep(.003)
        position =- 1
        return position
     
    def Reculer(position):
        print("reculer")
        i=position&2 + 1
        GPIO.output(pin1,Apin1[-i])
        GPIO.output(pin2,Apin2[-i])
        GPIO.output(pin3,Apin3[-i])
        GPIO.output(pin4,Apin4[-i])
        GPIO.output(pin5,Apin5[i])
        GPIO.output(pin6,Apin6[i])
        GPIO.output(pin7,Apin7[i])
        GPIO.output(pin8,Apin8[i])             
        time.sleep(.003)
        position =- 1
        return position
     
    def ReculerDroite(position):
        print("reculer droite")
        i=position&2 + 1
        GPIO.output(pin1,Apin1[-i])
        GPIO.output(pin2,Apin2[-i])
        GPIO.output(pin3,Apin3[-i])
        GPIO.output(pin4,Apin4[-i])        
        GPIO.output(pin5,Apin5[-i])
        GPIO.output(pin6,Apin6[-i])
        GPIO.output(pin7,Apin7[-i])
        GPIO.output(pin8,Apin8[-i])
        time.sleep(.003)
        position =+ 1
        return position
     
    def ReculerGauche(position):
        print("reculer gauche")
        i=position&2 + 1
        GPIO.output(pin1,Apin1[-i])
        GPIO.output(pin2,Apin2[-i])
        GPIO.output(pin3,Apin3[-i])
        GPIO.output(pin4,Apin4[-i])        
        GPIO.output(pin5,Apin5[-i])
        GPIO.output(pin6,Apin6[-i])
        GPIO.output(pin7,Apin7[-i])
        GPIO.output(pin8,Apin8[-i])
        time.sleep(.003)
        position =- 1
        return position
     
    # programme principal
    try:
      while True:     
        #dist = distance()
        #print ("%.1f cm" % dist)
        print (position)
     
        #if(dist<= 5):
        position= Reculer(position)        
        time.sleep(2)
        ReculerDroite(position)        
        time.sleep(2)     
        ReculerGauche(position)        
        time.sleep(2) 
     
        #else:
        Avancer(position)        
        time.sleep(2)
        AvancerDroite(position)        
        time.sleep(2)     
        position=AvancerGauche(position)        
        time.sleep(2)        
     
    # remise en place de tous les GPIO
    except KeyboardInterrupt:
        GPIO.cleanup()

+ Répondre à la discussion
Cette discussion est résolue.

Discussions similaires

  1. Projet sur Robot avec detecteur à ultrasons
    Par nats16 dans le forum LabVIEW
    Réponses: 2
    Dernier message: 08/03/2010, 09h21
  2. programation du robot avec visual basic
    Par lokardz dans le forum Robotique
    Réponses: 2
    Dernier message: 10/06/2009, 21h34
  3. programation du robot avec visuel basic
    Par lokardz dans le forum VB.NET
    Réponses: 1
    Dernier message: 23/03/2009, 01h44
  4. Interdire le https aux robots avec htaccess
    Par Guillaume.G dans le forum Apache
    Réponses: 2
    Dernier message: 11/11/2008, 17h26
  5. Deplacement d'un controle avec la souris
    Par hepsilonz dans le forum MFC
    Réponses: 6
    Dernier message: 23/12/2005, 15h42

Partager

Partager
  • Envoyer la discussion sur Viadeo
  • Envoyer la discussion sur Twitter
  • Envoyer la discussion sur Google
  • Envoyer la discussion sur Facebook
  • Envoyer la discussion sur Digg
  • Envoyer la discussion sur Delicious
  • Envoyer la discussion sur MySpace
  • Envoyer la discussion sur Yahoo