code petit robot pour homologation
Fork of CRAC-Strat_2017_V2 by
Instruction/Instruction.cpp
- Committer:
- antbig
- Date:
- 2016-04-15
- Revision:
- 1:116040d14164
- Parent:
- 0:ad97421fb1fb
- Child:
- 4:88431b537477
File content as of revision 1:116040d14164:
#include "Instruction.h" char cheminFileStart[SIZE+8]="/local/"; struct S_Instruction strat_instructions[SIZE_BUFFER_FILE];//Liste des instructions unsigned char nb_instructions = 0;//Le nombre d'instruction dans le fichier de strategie unsigned char actual_instruction = 0;//La ligne de l'instruction en cours d'execution LocalFileSystem local("local"); enum E_InstructionType charToInstructionType(char type) { switch(type) { case 'C': return MV_COURBURE; case 'L': return MV_LINE; case 'T': return MV_TURN; case 'X': return MV_XYT; case 'R': return MV_RECALAGE; case 'A': return ACTION; default: return UNKNOWN; } } enum E_InstructionDirection charToInstructionDirection(char type) { switch(type) { case 'B': return BACKWARD; case 'F': return FORWARD; case 'R': return RELATIVE; case 'A': return ABSOLUTE; default: return NODIRECTION; } } enum E_InstructionPrecisionOuRecalage charToInstructionPrecisionOuRecalage(char type) { switch(type) { case 'P': return PRECISION; case 'X': return RECALAGE_X; case 'Y': return RECALAGE_Y; default: return NOPRECISION; } } enum E_InstructionNextActionType charToInstructionNextActionType(char type) { switch(type) { case 'J': return JUMP; case 'W': return WAIT; case 'E': return ENCHAINEMENT; default: return NONEXTACTION; } } enum E_InstructionNextActionJumpType charToInstructionNextActionJumpType(char type) { switch(type) { case 'T': return JUMP_TIME; case 'P': return JUMP_POSITION; default: return NONEXTACTIONJUMPTYPE; } } struct S_Instruction stringToInstruction(char line[]) { struct S_Instruction instruction; char instructionOrder; char instructionDirection; char instructionPrecision; char instructionNextActionType; char instructionJumpAction; int errorCode = 0; /* Info sur la fonction sscanf %d -> Entier signé %u -> Entié non signé %c -> char */ errorCode = sscanf(line, "%d,%c,%c,%u,%u,%d,%c,%c,%c,%u,%u,%d,%d", &instruction.lineNumber, &instructionOrder, &instructionDirection, &instruction.arg1, &instruction.arg2, &instruction.arg3, &instructionPrecision, &instructionNextActionType, &instructionJumpAction, &instruction.JumpTimeOrX, &instruction.JumpY, &instruction.nextLineOK, &instruction.nextLineError ); /* if(errorCode != 13) { errorInstructionLoop();//L'instruction est pas bonne !! }*/ instruction.order = charToInstructionType(instructionOrder); instruction.direction = charToInstructionDirection(instructionDirection); instruction.precision = charToInstructionPrecisionOuRecalage(instructionPrecision); instruction.nextActionType = charToInstructionNextActionType(instructionNextActionType); instruction.jumpAction = charToInstructionNextActionJumpType(instructionJumpAction); return instruction; } void loadAllInstruction(void) { struct S_Instruction instruction; char LineBuffer[SIZE]; printf("Reading file : "); printf(cheminFileStart); printf("\n"); FILE *testFile = fopen(cheminFileStart, "rt"); //Ouverture du fichier en mode lecture seul au format string nb_instructions = 0; while (fgets(LineBuffer, SIZE, testFile) != NULL) { instruction = stringToInstruction(LineBuffer); strat_instructions[nb_instructions] = instruction; if(strat_instructions[nb_instructions].order == UNKNOWN) { errorInstructionLoop();//L'instruction est pas bonne !! } //printf(LineBuffer); //debug_Instruction(instruction); nb_instructions++; } printf("nb instruction = %d\n",nb_instructions); fclose(testFile); }