![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
Test
motors.cpp@1:2fe8c402ee79, 2020-07-08 (annotated)
- Committer:
- Nanaud
- Date:
- Wed Jul 08 20:42:19 2020 +0000
- Revision:
- 1:2fe8c402ee79
- Parent:
- 0:dc036b67c87c
- Child:
- 3:3ba377aafdfd
Amelioration de la lisibilite du code
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Nanaud | 1:2fe8c402ee79 | 1 | // Nom du fichier : motors.cpp |
Nanaud | 0:dc036b67c87c | 2 | #include "pins.h" |
Nanaud | 0:dc036b67c87c | 3 | |
Nanaud | 0:dc036b67c87c | 4 | void drv_init(){ |
Nanaud | 0:dc036b67c87c | 5 | mot_dis(); |
Nanaud | 0:dc036b67c87c | 6 | } |
Nanaud | 0:dc036b67c87c | 7 | |
Nanaud | 0:dc036b67c87c | 8 | void test_drv(){ |
Nanaud | 0:dc036b67c87c | 9 | mot_en(); |
Nanaud | 0:dc036b67c87c | 10 | motGauche_fwd(); |
Nanaud | 0:dc036b67c87c | 11 | drvGauche.move(1); |
Nanaud | 0:dc036b67c87c | 12 | wait(2); |
Nanaud | 0:dc036b67c87c | 13 | motGauche_bck(); |
Nanaud | 0:dc036b67c87c | 14 | wait(2); |
Nanaud | 0:dc036b67c87c | 15 | mot_dis(); |
Nanaud | 0:dc036b67c87c | 16 | } |
Nanaud | 0:dc036b67c87c | 17 | |
Nanaud | 0:dc036b67c87c | 18 | // ENABLE/DISABLE // Les deux modules ont le même enable |
Nanaud | 0:dc036b67c87c | 19 | void mot_en(){ |
Nanaud | 0:dc036b67c87c | 20 | drvGauche.setEnable(START); |
Nanaud | 0:dc036b67c87c | 21 | //drvDroite.setEnable(START); |
Nanaud | 0:dc036b67c87c | 22 | } |
Nanaud | 0:dc036b67c87c | 23 | |
Nanaud | 0:dc036b67c87c | 24 | void mot_dis(){ |
Nanaud | 0:dc036b67c87c | 25 | drvGauche.setEnable(STOP); |
Nanaud | 0:dc036b67c87c | 26 | //drvDroite.setEnable(STOP); |
Nanaud | 0:dc036b67c87c | 27 | } |
Nanaud | 0:dc036b67c87c | 28 | |
Nanaud | 0:dc036b67c87c | 29 | // FORWARD |
Nanaud | 0:dc036b67c87c | 30 | void motGauche_fwd(){ |
Nanaud | 0:dc036b67c87c | 31 | drvGauche.setDir(FORWARD); |
Nanaud | 0:dc036b67c87c | 32 | } |
Nanaud | 0:dc036b67c87c | 33 | |
Nanaud | 0:dc036b67c87c | 34 | void motDroite_fwd(){ |
Nanaud | 0:dc036b67c87c | 35 | drvDroite.setDir(FORWARD); |
Nanaud | 0:dc036b67c87c | 36 | } |
Nanaud | 0:dc036b67c87c | 37 | |
Nanaud | 0:dc036b67c87c | 38 | // BACKWARD |
Nanaud | 0:dc036b67c87c | 39 | void motGauche_bck(){ |
Nanaud | 0:dc036b67c87c | 40 | drvGauche.setDir(BACKWARD); |
Nanaud | 0:dc036b67c87c | 41 | } |
Nanaud | 0:dc036b67c87c | 42 | |
Nanaud | 0:dc036b67c87c | 43 | void motDroite_bck(){ |
Nanaud | 0:dc036b67c87c | 44 | drvDroite.setDir(BACKWARD); |
Nanaud | 0:dc036b67c87c | 45 | } |