/*
 * $Id: $
 *
 * Copyright © 2009 Keith Packard
 *
 * Permission to use, copy, modify, distribute, and sell this software and its
 * documentation for any purpose is hereby granted without fee, provided that
 * the above copyright notice appear in all copies and that both that
 * copyright notice and this permission notice appear in supporting
 * documentation, and that the name of Keith Packard not be used in
 * advertising or publicity pertaining to distribution of the software without
 * specific, written prior permission.  Keith Packard makes no
 * representations about the suitability of this software for any purpose.  It
 * is provided "as is" without express or implied warranty.
 *
 * KEITH PACKARD DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE,
 * INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO
 * EVENT SHALL KEITH PACKARD BE LIABLE FOR ANY SPECIAL, INDIRECT OR
 * CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE,
 * DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
 * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
 * PERFORMANCE OF THIS SOFTWARE.
 */

#include "ao.h"

const char const * const ao_state_names[] = {
	"startup", "idle", "pad", "boost", "coast",
	"apogee", "drogue", "main", "landed", "invalid"
};

__xdata uint8_t ao_monitoring;

void
ao_monitor(void)
{
	__xdata struct ao_radio_recv recv;
	uint8_t state;

	for (;;) {
		__critical while (!ao_monitoring)
			ao_sleep(&ao_monitoring);
		ao_radio_recv(&recv);
		state = recv.telemetry.flight_state;
		if (state > ao_flight_invalid)
			state = ao_flight_invalid;
		printf ("SERIAL %3d RSSI %3d STATUS %02x STATE %s ",
			recv.telemetry.addr, recv.rssi, recv.status,
			ao_state_names[state]);
		if (!(recv.status & PKT_APPEND_STATUS_1_CRC_OK))
			printf("CRC INVALID ");
		printf("%5u a: %d p: %d t: %d v: %d d: %d m: %d ",
		       recv.telemetry.adc.tick,
		       recv.telemetry.adc.accel,
		       recv.telemetry.adc.pres,
		       recv.telemetry.adc.temp,
		       recv.telemetry.adc.v_batt,
		       recv.telemetry.adc.sense_d,
		       recv.telemetry.adc.sense_m);
		ao_gps_print(&recv.telemetry.gps);
		ao_usb_flush();
	}
}

__xdata struct ao_task ao_monitor_task;

static void
ao_set_monitor(void)
{
	ao_cmd_hex();
	ao_monitoring = ao_cmd_lex_i != 0;
	ao_wakeup(&ao_monitoring);
}

__code struct ao_cmds ao_monitor_cmds[] = {
	{ 'M',	ao_set_monitor,	"M                                  Enable/disable radio monitoring" },
	{ 0,	ao_set_monitor,	NULL },
};

void
ao_monitor_init(void)
{
	ao_monitoring = 0;
	ao_cmd_register(&ao_monitor_cmds[0]);
	ao_add_task(&ao_monitor_task, ao_monitor, "monitor");
}