98 lines
		
	
	
		
			2.0 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			98 lines
		
	
	
		
			2.0 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| #include "factory.h"
 | |
| 
 | |
| 
 | |
| //the factory object containing all objects of our system
 | |
| static Factory theFactory;
 | |
| 
 | |
| //all the getters
 | |
| LED* l1() {
 | |
|     return &theFactory.l1_;
 | |
| }
 | |
| LED* l2()  {
 | |
|     return &theFactory.l2_;
 | |
| }
 | |
| LED* l3()  {
 | |
|     return &theFactory.l3_;
 | |
| }
 | |
| LED* l4()  {
 | |
|     return &theFactory.l4_;
 | |
| }
 | |
| LED* l5()  {
 | |
|     return &theFactory.l5_;
 | |
| }
 | |
| LED* l6()  {
 | |
|     return &theFactory.l6_;
 | |
| }
 | |
| LED* l7()  {
 | |
|     return &theFactory.l7_;
 | |
| }
 | |
| LED* l8()  {
 | |
|     return &theFactory.l8_;
 | |
| }
 | |
| 
 | |
| WATCHDOG* WDcontroller(){
 | |
|     return &theFactory.WDcontroller_;
 | |
| }
 | |
| 
 | |
| ALIVE_CHECKER* ACjoy() {
 | |
|     return &theFactory.ACjoy_;
 | |
| }
 | |
| 
 | |
| 
 | |
| //initialize all objects
 | |
| void Factory_init() {
 | |
|     LED_init(l1(), 1);
 | |
|     LED_init(l2(), 2);
 | |
|     LED_init(l3(), 3);
 | |
|     LED_init(l4(), 4);
 | |
|     LED_init(l5(), 5);
 | |
|     LED_init(l6(), 6);
 | |
|     LED_init(l7(), 7);
 | |
|     LED_init(l8(), 8);
 | |
| 
 | |
|     LED_initHW(l1());
 | |
|     LED_initHW(l2());
 | |
|     LED_initHW(l3());
 | |
|     LED_initHW(l4());
 | |
|     LED_initHW(l5());
 | |
|     LED_initHW(l6());
 | |
|     LED_initHW(l7());
 | |
|     LED_initHW(l8());
 | |
| 
 | |
|     CAN_init();
 | |
|     CAN_setSender(1);
 | |
|     LED_off(l1());
 | |
|     
 | |
|     // TODO init EPROM interface
 | |
|     MEM_init();
 | |
|     
 | |
|     // TODO init watchdog with EPROM CST 
 | |
|     WATCHDOG_init(WDcontroller());
 | |
|     WATCHDOG_setTime(WDcontroller(), CAR_CST.CONTROL_ALIVE_TIME);
 | |
|     
 | |
|     ALIVE_CHECKER_init(ACjoy());
 | |
| }
 | |
| 
 | |
| //connect objects if required
 | |
| void Factory_build() {    
 | |
|     ECAN_SetRXBnInterruptHandler(CAN_newMsg);
 | |
|     CAN_onReceiveCan(CM_processIncome);
 | |
|     
 | |
|     WATCHDOG_onAlive(WDcontroller(), CM_CONTROLLER_ALIVE, NULL);
 | |
|     ALIVE_CHECKER_onSetup(ACjoy(), CM_JOY_SETUP, NULL);
 | |
|     ALIVE_CHECKER_setAliveTime(ACjoy(), CAR_CST.JOYSTICK_ALIVE_TIME);
 | |
|     ALIVE_CHECKER_onBorn(ACjoy(), LED_on, l1());
 | |
|     ALIVE_CHECKER_onDead(ACjoy(), LED_off, l1());
 | |
|     
 | |
| }
 | |
| 
 | |
| //start all state machines
 | |
| void Factory_start() {
 | |
|     CAN_startBehaviour();
 | |
|     WATCHDOG_startBehaviour(WDcontroller());
 | |
|     ALIVE_CHECKER_startBehaviour(ACjoy());
 | |
|     ALIVE_CHECKER_emitBorn(ACjoy(), 100, 0);
 | |
|     ALIVE_CHECKER_emitReady(ACjoy(), 200, 0);
 | |
|     
 | |
| }
 |