Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-02-01 21:48:28 -04:00
Code Issues Packages Projects Releases Wiki Activity

Copter: integrate EPM ver2

Browse Source
This commit is contained in:
Randy Mackay 2014-09-15 15:52:21 +09:00
parent 1401ee4077
commit 14d80910ec
5 changed files with 21 additions and 10 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
ArduCopter/ArduCopter.pde
View File

@ -823,6 +823,9 @@ static const AP_Scheduler::Task scheduler_tasks[] PROGMEM = {
#if FRSKY_TELEM_ENABLED == ENABLED
{ telemetry_send, 80, 10 },
#endif
#if EPM_ENABLED == ENABLED
{ epm_update, 40, 10 },
#endif
#ifdef USERHOOK_FASTLOOP
{ userhook_FastLoop, 4, 10 },
#endif
@ -888,6 +891,9 @@ static const AP_Scheduler::Task scheduler_tasks[] PROGMEM = {
#if FRSKY_TELEM_ENABLED == ENABLED
{ telemetry_send, 20, 100 },
#endif
#if EPM_ENABLED == ENABLED
{ epm_update, 10, 20 },
#endif
#ifdef USERHOOK_FASTLOOP
{ userhook_FastLoop, 1, 100 },
#endif

4
ArduCopter/defines.h
View File

@ -292,8 +292,8 @@ enum FlipState {
#define DATA_ACRO_TRAINER_DISABLED 43
#define DATA_ACRO_TRAINER_LEVELING 44
#define DATA_ACRO_TRAINER_LIMITED 45
#define DATA_EPM_ON 46
#define DATA_EPM_OFF 47
#define DATA_EPM_GRAB 46
#define DATA_EPM_RELEASE 47
#define DATA_EPM_NEUTRAL 48
#define DATA_PARACHUTE_DISABLED 49
#define DATA_PARACHUTE_ENABLED 50

8
ArduCopter/sensors.pde
View File

@ -133,3 +133,11 @@ void read_receiver_rssi(void)
receiver_rssi = constrain_int16(ret, 0, 255);
}
}
#if EPM_ENABLED == ENABLED
// epm update - moves epm pwm output back to neutral after grab or release is completed
void epm_update()
{
epm.update();
}
#endif

8
ArduCopter/switches.pde
View File

@ -310,16 +310,16 @@ static void do_aux_switch_function(int8_t ch_function, uint8_t ch_flag)
case AUX_SWITCH_EPM:
switch(ch_flag) {
case AUX_SWITCH_LOW:
epm.off();
Log_Write_Event(DATA_EPM_OFF);
epm.release();
Log_Write_Event(DATA_EPM_RELEASE);
break;
case AUX_SWITCH_MIDDLE:
epm.neutral();
Log_Write_Event(DATA_EPM_NEUTRAL);
break;
case AUX_SWITCH_HIGH:
epm.on();
Log_Write_Event(DATA_EPM_ON);
epm.grab();
Log_Write_Event(DATA_EPM_GRAB);
break;
}
break;

5
ArduCopter/system.pde
View File

@ -131,17 +131,14 @@ static void init_ardupilot()
BoardConfig.init();
bool enable_external_leds = true;
// init EPM cargo gripper
#if EPM_ENABLED == ENABLED
epm.init();
enable_external_leds = !epm.enabled();
#endif
// initialise notify system
// disable external leds if epm is enabled because of pin conflict on the APM
notify.init(enable_external_leds);
notify.init(true);
// initialise battery monitor
battery.init();