Klagarge/SummerSchool2-Controller
Archived
1
0
Fork 0
Code Issues Pull Requests Projects 1 Releases 1 Activity

test drive

Browse Source
This commit is contained in:
Rémi Heredero
2023-08-31 17:02:23 +02:00
parent dc6e4ec65a
commit d31544783c
4 changed files with 52 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

39
306-controller_interface.X/app/factory/factory.c
View File

@ -42,6 +42,10 @@ ALIVE* ALjoy(){
return &theFactory.ALjoy_;
}
ALIVE* ALdrive(){
return &theFactory.ALdrive_;
}
//initialize all objects
void Factory_init() {
@ -75,6 +79,20 @@ void Factory_init() {
ALIVE_setAliveTime(ALcontroller(), KART_CST.CONTROL_ALIVE_TIME);
ALIVE_init(ALjoy());
ALIVE_init(ALdrive());
}
void foo(void* p){
static int16_t speed = 0;
static bool up = true;
if(up) {
speed += 3;
if(speed >100) up = false;
} else {
speed -= 3;
if(speed < -100) up = true;
}
CM_DRIVE_POWER(&speed);
}
//connect objects if required
@ -84,26 +102,39 @@ void Factory_build() {
ALIVE_onAlive(ALcontroller(), CM_CONTROLLER_ALIVE, NULL);
BLINKER_onOn(b1(), LED_on, l6());
BLINKER_onOff(b1(), LED_off, l6());
//BLINKER_onOn(b1(), LED_on, l6());
//BLINKER_onOff(b1(), LED_off, l6());
ALIVE_onSetup(ALjoy(), CM_JOY_SETUP, NULL);
ALIVE_setAliveTime(ALjoy(), KART_CST.JOYSTICK_ALIVE_TIME);
ALIVE_onBorn(ALjoy(), LED_on, l1());
ALIVE_onDead(ALjoy(), LED_off, l1());
ALIVE_onSetup(ALdrive(), CM_DRIVE_SETUP, NULL);
ALIVE_setAliveTime(ALdrive(), KART_CST.DRIVE_ALIVE_TIME);
ALIVE_onBorn(ALdrive(), LED_on, l2());
ALIVE_onDead(ALdrive(), LED_off, l2());
BLINKER_setTimeOn(b1(), (KART_CST.DRIVE_STOP_TIME*9)/2);
BLINKER_setTimeOff(b1(), (KART_CST.DRIVE_STOP_TIME*9)/2);
BLINKER_onOn(b1(), foo, NULL);
}
//start all state machines
void Factory_start() {
CAN_startBehaviour();
BLINKER_startBehaviour(b1());
BLINKER_emitBlink(b1(), 0);
ALIVE_startBehaviourSender(ALcontroller());
ALIVE_startBehaviourChecker(ALjoy());
ALIVE_emitBorn(ALjoy(), 100, 0);
ALIVE_emitReady(ALjoy(), 200, 0);
ALIVE_startBehaviourChecker(ALdrive());
ALIVE_emitBorn(ALdrive(), 100, 0);
ALIVE_emitReady(ALdrive(), 200, 0);
BLINKER_startBehaviour(b1());
BLINKER_emitBlink(b1(), 300);
}

2
306-controller_interface.X/app/factory/factory.h
View File

@ -36,6 +36,7 @@ typedef struct {
ALIVE ALcontroller_;
ALIVE ALjoy_;
ALIVE ALdrive_;
} Factory;
@ -58,6 +59,7 @@ BLINKER* b1();
ALIVE* ALcontroller();
ALIVE* ALjoy();
ALIVE* ALdrive();
#endif