You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
22 lines
643 B
22 lines
643 B
10 years ago
|
#include "MsgHandler_Event.h"
|
||
|
|
|
||
|
|
extern const AP_HAL::HAL& hal;
|
||
|
|
|
||
|
|
#define DATA_ARMED 10
|
||
|
|
#define DATA_DISARMED 11
|
||
|
|
|
||
|
|
void MsgHandler_Event::process_message(uint8_t *msg)
|
||
|
|
{
|
||
|
|
uint8_t id = require_field_uint8_t(msg, "Id");
|
||
|
|
if (id == DATA_ARMED) {
|
||
|
|
hal.util->set_soft_armed(true);
|
||
|
|
printf("Armed at %lu\n",
|
||
|
|
(unsigned long)hal.scheduler->millis());
|
||
|
|
} else if (id == DATA_DISARMED) {
|
||
|
|
hal.util->set_soft_armed(false);
|
||
|
|
printf("Disarmed at %lu\n",
|
||
|
|
(unsigned long)hal.scheduler->millis());
|
||
|
|
}
|
||
|
|
dataflash.WriteBlock(msg, f.length);
|
||
|
|
}
|