void systemInitial(void){ m_clockdivide(0); wirelessinitial(); TimerSetup(); //m_usb_init(); //while(!m_imu_init(1,0)); //sei(); //while(!m_usb_isconnected()); }
void Transceiver::Init(IMBuffer & buf) { buffer=&buf; if(!NoRadio) buffer->Init(); buffer->setFunction(&timer.doneReceived); TimerSetup(0); Deconnect(); }
bool Transceiver::ReceiveWelcome(IMFrame & frame) { IMFrameSetup * setup =frame.Setup(); // DBGINFO("\r\n%MAC"); // DBGINFO(setup->MAC); // DBGINFO(":"); // DBGINFO(setup->MAC2); if (setup->MAC!=myMAC) { DBGINFO("*****NOT FORME "); DBGINFO(myMAC); BackwardWelcome(frame); return false; } //_helloed=_knocked +200; //we can wait on next connection timer.Watchdog(); serverId=frame.Header.SourceId; myId=setup->address; myChannel=setup->slavechannel; hostRssiSend=setup->rssi; router.myId=myId; HostChannel=0; myChannel=0; _calibrateshift=0; _connected=1; TimerSetup((myId &16)*10); // BroadcastEnable=(setup->mode && IMS_TRANSCEIVER); setupMode(setup->mode); if (myHop==2) { _calibrateshift=200; DBGINFO("C200SHIFT"); } _cycleshift=(timer.Cycle()+myId) % _cycledata; _helloCycle=timer.Cycle()+TimerHelloCycle*_cycledata;//setup next Hello DBGINFO(myId); DBGINFO("CONNECT%"); StopListenBroadcast(); // no listen until data stage return true; }
void SystemSetup(void) { IORegSetup(); // Setup.c #if defined(USE_TIMER) TimerRegSetup(); // Setup.c TimerSetup(); // Setup.c #endif #if (defined(USE_UART) || defined(USE_MU)) UartRegSetup(); // Setup.c UartSetup(); // Uart.c #endif #if defined(USE_EXINT) ExintRegSetup(); // Setup.c #endif #if defined(USE_PCINT) PcintRegSetup(); // Setup.c #endif #if defined(USE_EXINT) ExintSetup(); #endif #if defined(USE_PCINT) PcintSetup(); #endif #if defined(USE_ENCODER) EncoderSetup(); // Encoder.c #endif #if defined(USE_MU) MuSetup(); // Mu.c #endif #if defined(USE_MOTOR) MotorSetup(); // Motor.c #endif #if defined(USE_SERVO) ServoSetup(); // Servo.c #endif #if defined(USE_SAFETY) SafetySetup(); // Safety.c #endif }
void FLIR_Tasks ( void ) { LEP_RESULT result; /* Check the application's current state. */ switch ( flirData.state ) { /* Application's initial state. */ case FLIR_STATE_INIT: { bool appInitialized = true; if (flirData.handleTmrDrv == DRV_HANDLE_INVALID) { flirData.handleTmrDrv = DRV_TMR_Open(FLIR_TMR_DRV, DRV_IO_INTENT_EXCLUSIVE); appInitialized &= ( DRV_HANDLE_INVALID != flirData.handleTmrDrv ); } if (appInitialized) { TimerSetup(); BSP_LEDOn(BSP_LED_1); flirData.state = FLIR_OPEN_PORT; } break; } case FLIR_OPEN_PORT: { BSP_LEDOn(BSP_LED_2); result = LEP_OpenPort(0, LEP_CCI_TWI, #ifdef BB_ENABLED DRV_I2C_BIT_BANG_BAUD_RATE_IDX0 #else DRV_I2C_BAUD_RATE_IDX0 #endif /1000,&flirData.lepton.cameraPort); if(result != LEP_OK) { flirData.state = FLIR_ERROR; } else { BSP_LEDOff(BSP_LED_1); BSP_LEDOff(BSP_LED_2); BSP_LEDOff(BSP_LED_3); BSP_LEDOn(BSP_LED_4); flirData.state = FLIR_STATE_SERVICE_TASKS; } break; } case FLIR_STATE_SERVICE_TASKS: { LedTask(); break; } /* TODO: implement your application state machine.*/ case FLIR_ERROR: default: { BSP_LEDOn(BSP_LED_1); BSP_LEDOn(BSP_LED_2); BSP_LEDOn(BSP_LED_3); BSP_LEDOn(BSP_LED_4); break; } } }
void systemInitial(void){ m_clockdivide(0); wirelessinitial(); TimerSetup(); }