Team 9 / FRDM-TFC

Fork of FRDM-TFC by Ian Krase

main.cpp

Committer:
emh203
Date:
2013-07-17
Revision:
2:ce4a273be708
Parent:
0:cd9427630ad1
Child:
3:23cce037011f

File content as of revision 2:ce4a273be708:

#include "mbed.h"
#include "TFC.h"
 
DigitalOut myled(LED1);
Ticker TFC_TickerObj;
Serial PC(USBTX,USBRX);
 
#define NUM_TFC_TICKERS 4
 
volatile uint32_t TFC_Ticker[NUM_TFC_TICKERS];
 
void TFC_TickerUpdate()
{
    int i;
 
    for(i=0; i<NUM_TFC_TICKERS; i++) {
        if(TFC_Ticker[i]<0xFFFFFFFF) {
            TFC_Ticker[0]++;
        }
    }
}
 
 
 
 
int main()
{
    //  int i;
 
 
    PC.baud(9600);
    TFC_TickerObj.attach_us(&TFC_TickerUpdate,1000);
   __disable_irq();
   
    TFC_Init();
    __enable_irq();
// TFC_Init();
    while(1) 
    {
 
        if(TFC_ServoTicker >0) 
        {
            TFC_ServoTicker = 0;
 
            TFC_SetBatteryLED(TFC_GetDIP_Switch());
 
            if(TFC_DIP_SWITCH_0_ON) {
                  if(TFC_PUSH_BUTTON_0_PRESSED)
                   TFC_SetServo(0,0.2);
                else if(TFC_PUSH_BUTTON_1_PRESSED)
                   TFC_SetServo(0,-0.2);
                else
                 TFC_SetServo(0,TFC_ReadPot(0));
            }
 
 
            if(TFC_DIP_SWITCH_1_ON) {
                TFC_HBRIDGE_ENABLE;
                TFC_SetMotorPWM(TFC_ReadPot(1) ,TFC_ReadPot(1));
            } else {
                TFC_HBRIDGE_DISABLE;
            }
            
          
        }
 
 
            if(TFC_Ticker[0]>500)
            {
                 TFC_Ticker[0] = 0;
                  PC.printf("Servo Ticker %i",TFC_ServoTicker);
            }
 
 
 
    }
 
}