/***************************************************************************

Stage_LEDs.c

****************************************************************************/

#include "Stage_LEDs.h"

 

/*-------------------------- Module Constants -----------------------------*/

 

/*------------------------- Module Definitions ----------------------------*/

 

/*-------------------------- Module Variables -----------------------------*/

 

/*-------------------------- Module Functions -----------------------------*/

 

/*---------------------------- Module Code ------------------------------*/

void resetStage(void) {

  PTT = PTT & 0xF3;                   //11110011. Set Bit 2 and 3 lo/off

}

 

void activateStage(STAGE_t myStage) {

    char myLEDIndex;

    switch (myStage) {

      case STAGE_IDLE:

          myLEDIndex = 0;

      break;

     

      case STAGE_IR:

          myLEDIndex = 2;

      break;

     

      case STAGE_GRAPPLE:

          myLEDIndex = 3;

      break;

     

      case STAGE_DOWNLOAD:

          myLEDIndex = 1;

      break;

    }

    PTT = PTT & (BIT2LO);              //Initially set all LEDs off by setting both decoder select     

    PTT = PTT & (BIT3LO);              //lines to lo

 

    PTT = PTT | (0x04*myLEDIndex);     //Set desired LED on

}