Schema et montage de robot : Construction d'un robot suiveur de lumière

Présentation
Ce robot s'oriente en fonction de l'intensité de la lumière qu'il reçoit. 2 diodes Pin I.R. permettent de comparer la provenance de l'intensité lumineuse.
Il posséde 2 capteurs d'obstacles. Un bip sonore est émis lorqu'un obstacle est touché et le robot procéde à une procédure d'évitement.
Il est propulsé par 2 servos modifiés à rotation continue .


robot synoptique 
L' électronique
  • Le coeur du montage est basé sur un microcontrôleur AT90S2313 de ATMEL.
  • La programmation se fait in situ (en circuit) par l'intermédiaire du connecteur K1.
  •  L'alimentation utilise 6 accus de 1,25 v NI- MH, type R6.
  • CI1 assure l'alimentation en 5V pour le microcontrôleur. Les servos fonctionnent en 7,5V.
  • D3 et D4 indiquent d'où provient la lumière.
  • S1 et S2 sont les 2 microswitchs détectant les obstacles.
  • Les servos modifiés peuvent être commandés sur le site de Robotshop .
 Schema structurel :


La construction
Le circuit étant peu complexe j'ai utilisé une plaquette d'expérimentation à trous pastillés.
Les diodes pin sont à placer vers l'avant et il faut prévoir une cloison pour bien séparer les 2 capteurs de lumière. 


 

Le châssis est réalisé en PVC expansé 3 mm, les 2 côtés sont pliés et possédent des ouvertures pour laisser passer les servos .
Les servos sont fixés par des colliers de serrage pour câbles électriques.
En dessous du châssis se placent les 2 microswitchs et les 2 servos.
Une roulette à bille permet la rotation aisée du robot . 


 
Le coupleur de piles peut se placer sous le circuit. Il faut prévoir des entretoises assez longues.
Sur les microswitchs, on peut coller une plaque métallique pour prolonger la lamelle. 


 
 La programmation
La programmation se fait en basic avec le logiciel BASCOM AVR (version d'évaluation). Le fichier HEX n'occupe que 2 Ko. ce logiciel est disponible sur le site de MCS electronics.
Le microcontrôleur se programme aisément in situ avec un programmateur compatible STK200 / STK300.
J'utilise un programmateur sur le port parallèle de construction personnelle. (Vous trouverez sur cette page plusieurs projets de realisation de programmateurs .)

 

 Dessin  développé du châssis du robot suiveur de lumière

 
Le fichier source :

' Robot chercheur de lumière' JMD 18/11/2007$regfile = "2313DEF.dat"Dim T As IntegerDdrb.0 = 0                                                'Comparateur Diode PinDdrb.1 = 0                                                'Comparateur référenceDdrb.2 = 1                                                'Led 1Ddrb.3 = 1Ddrb.4 = 1                                                'Led 2Ddrd.0 = 1                                                'Servo 1Ddrd.1 = 1                                                'Servo 2Ddrd.4 = 0                                                'Inter 1Ddrd.5 = 0                                                'Inter 2For T = 0 To 4   Portb.2 = 0   Portb.3 = 1Waitms 300   Portb.3 = 0   Portb.2 = 1   Sound Portb.4 , 50 , 4000Waitms 300Next TConfig Servos = 2 , Servo1 = Portd.0 , Servo2 = Portd.1 , Reload = 10Enable Interrupts$crystal = 8000000Portd.4 = 1Portd.5 = 1' Servo (1) = 80, Servo(2)=170 Marche avantDo   If Pind.5 = 0 Then Gosub Retourd   If Pind.4 = 0 Then Gosub Retourg   If Acsr.5 = 1 Then                             ' Bit 5 Registre  comparateur      Servo(1) = 80      Servo(2) = 170      Portb.2 = 1      Portb.3 = 0      Waitms 50      Servo(1) = 170      Servo(2) = 170      Waitms 20   Else      Servo(1) = 80      Servo(2) = 170      Portb.2 = 0      Portb.3 = 1      Waitms 50      Servo(2) = 80      Servo(1) = 80      Waitms 20   End IfLoopRetourd:   Servo(1) = 170   Servo(2) = 80   Sound Portb.4 , 100 , 250   Waitms 300   Servo(1) = 80   Portb.2 = 1   Portb.3 = 0   Waitms 250ReturnRetourg:   Servo(1) = 170   Servo(2) = 80   Sound Portb.4 , 100 , 250   Waitms 300   Servo(2) = 170   Portb.2 = 1   Portb.3 = 0   Waitms 250Return

Le fichier Hex :

:100000000AC0189518951895189518954EC018950A:100010001895189518958FED8DBFC0ECE8EB4E2E16:10002000DD275D2EEEE7F0E0A0E6B0E088278D93B7:100030003197E9F76624B898B998BA9ABB9ABC9AEE:10004000889A899A8C988D9880E090E0A0E68D93AC:100050009C93A0E60D911C91043050E0150714F01C:1000600009F01AC0C298C39A8CE291E0F1D0C3980B:10007000C29ABC9AE0EAFFE082E390E00197C49A5A:10008000DAD0C498D8D0482F492BC1F78CE291E040:10009000DFD0A0E6C6D0DDCF83B7816083BF89B74C:1000A000826089BF89ED82BF31C00F938F938FB774:1000B0008F93AF93BF939F93A2E68D919C910196EE:1000C0009C938E9300278130900719F4909A919A0F:1000D00013C0903041F0803D07E0900768F00027A2:1000E0000D930C9309C012969D91891708F0909872:1000F0009D91891708F0919889ED82BF9F91BF91DA:10010000AF918F918FBF8F910F9118957894949A9A:10011000959A0027A0E38C9185FB0EF401E040E066:10012000041709F001C03FD00027A0E38C9184FBA5:100130000EF401E040E0041709F001C053D000279D:10014000A8E28C9185FB0EF401E041E0041709F070:1001500015C080E5809364008AEA80936500C29AA6:10016000C39882E390E074D08AEA809364008AEABC:100170008093650084E190E06BD014C080E58093AB:1001800064008AEA80936500C298C39A82E390E093:100190005FD080E58093650080E58093640084E112:1001A00090E056D0B6CF8AEA8093640080E58093D1:1001B0006500BC9AEAEFF0E084E690E00197C49A0B:1001C0003AD0C49838D0482F492BC1F78CE291E03F:1001D0003FD080E580936400C29AC3988AEF90E094:1001E00037D008958AEA8093640080E580936500A3:1001F000BC9AEAEFF0E084E690E00197C49A1BD045:10020000C49819D0482F492BC1F78CE291E020D037:100210008AEA80936500C29AC3988AEF90E018D06A:100220000895ED91FC91EF5FFF4FFC93EE930895DD:100230003197F1F70895AE2FBF2F11974A2F4B2B0F:10024000E1F70895689462F80895E89462F80895D3:10025000EF93FF93EE27E82BE92B31F0E0EDF7E089:0E0260003197F1F70197D1F7FF91EF910895D3:00000001FF

Aucun commentaire:

Enregistrer un commentaire