test des capteurs/actionneurs petit robot

Fork of mbed_tes_cpt by CRAC Team

Actionneur.h

Committer:
matthieuvignon
Date:
2017-05-25
Revision:
5:7e1c328c5d50
Parent:
3:43843ab8af47

File content as of revision 5:7e1c328c5d50:

#include "all_includes.h"                 
                  
   
   
#define AX12_INITIALISATION 1
#define AX12_PREPARATION_PRISE 2
#define AX12_STOCKAGE_HAUT 3
#define AX12_STOCKAGE_BAS 4
#define AX12_DEPOSER 5
#define AX12_PREPARATION_DEPOT_HAUT 6
#define AX12_POUSSER_MODULE 7

#define AX12_POS_INIT_POMPE_JAUNE_AVANT 10      //0A
#define AX12_VIDER_FUSEE_POMPE_JAUNE_AVANT 11
#define AX12_POSE_MODULE_POMPE_JAUNE_AVANT 12
#define AX12_POSE_MODULE_POMPE_BLEU_AVANT 14
#define AX12_REMISE_PLACE_BRAS_POMPE_AVANT 15
#define AX12_REPOS_BRAS_POMPE_AVANT 16


#define AX12_POS_INIT_POMPE_JAUNE_ARRIERE 30        //1E
#define AX12_VIDER_FUSEE_POMPE_JAUNE_ARRIERE 31
#define AX12_POSE_MODULE_POMPE_JAUNE_ARRIERE  32
#define AX12_POSE_MODULE_POMPE_BLEU_ARRIERE  34
#define AX12_REMISE_PLACE_BRAS_POMPE_ARRIERE  35           //23
#define AX12_REPOS_BRAS_POMPE_ARRIERE  36

#define AX12_DESCENDRE_ASPIRATEUR 20
#define AX12_MONTER_ASPIRATEUR 21
#define AX12_FUNNY_ACTION 22

#define AX12_OUVRIR_PORTE 40
#define AX12_FERMER_PORTE 41

#define AX12_GET_POSITION 100
#define AX12_DEFAUT 0

#define TOLERANCE_AX12 50

void Fin_action(void);

unsigned char mvtBrasAvantPompe(unsigned char ID1, unsigned short GSpeed1, unsigned short GPosition1, 
                            unsigned char ID2, unsigned short GSpeed2, unsigned short GPosition2,
                            unsigned char ID3, unsigned short GSpeed3, unsigned short GPosition3);
  
unsigned char mvtBrasAvantModule(unsigned char ID1, unsigned short GSpeed1, unsigned short GPosition1, 
                            unsigned char ID2, unsigned short GSpeed2, unsigned short GPosition2,
                            unsigned char ID3, unsigned short GSpeed3, unsigned short GPosition3,
                            unsigned char ID4, unsigned short GSpeed4, unsigned short GPosition4); 
                            
unsigned char mvtBrasAspirateur(unsigned char ID1, unsigned short GSpeed1, unsigned short GPosition1, 
                            unsigned char ID2, unsigned short GSpeed2, unsigned short GPosition2,
                            unsigned char ID3, unsigned short GSpeed3, unsigned short GPosition3);