dt_ctrl.c

/*
	Copyright Jeroen Vreeken (pe1rxq@amsat.org), 2007 - 2013
	Copyright Stichting C.A. Muller Radioastronomiestation, 2007 - 2013

	This program is free software: you can redistribute it and/or modify
	it under the terms of the GNU General Public License as published by
	the Free Software Foundation, either version 3 of the License, or
	(at your option) any later version.

	This program is distributed in the hope that it will be useful,
	but WITHOUT ANY WARRANTY; without even the implied warranty of
	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
	GNU General Public License for more details.

	You should have received a copy of the GNU General Public License
	along with this program.  If not, see <http://www.gnu.org/licenses/>.

 */

#define _GNU_SOURCE

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <math.h>

#include "dynarg.h"

#include "controller_block.h"
#include "controller_trace.h"
#include "controller_sample.h"
#include "controller_dumpdot.h"
#include "controller_load.h"
#include "shell.h"
#include "ec.h"
#include "log.h"

#include "dt_port_numbers.h"


/********************************************
 *	Shell interface:
 */

int sample_timing(char *args, char *out, int *outlen)
{
	if (args && !strcmp(args, "print")) {
		*outlen = sprintf(out, "Sample timing:\n");
		*outlen += controller_sample_timing_snprintf(out + *outlen, 2000);
	} else if (args && !strcmp(args, "reset")) {
		controller_sample_timing_reset();
		*outlen = sprintf(out, "Sample timing has been cleared.\n");
	} else {
		*outlen = sprintf(out,
		     "Valid arguments are: 'reset' and 'print'\n");
	}

	return *outlen;
}


int main(int argc, char **argv)
{
	char *ctrl_filename;
	char *dot_filename;
	
	controller_block_param_init();
	
	if (argc < 2) {
		printf("Usage: %s <controllerfile>\n", argv[0]);
		printf("\n");
		printf("E.g.: %s dt_ctrl.ctrl\n", argv[0]);
		return 1;
	}
	
	ctrl_filename = argv[1];
	
	/* Create and link blocks */

	if (controller_load(ctrl_filename)) {
		printf("Could load controller file\n");
		return 1;
	}

	controller_trace_server_start(CTRL_TRACE_PORT, 100);

	/* Start command shell */
	
	shell_cmd_add(&(struct shell_cmd){"timing", "reset/print sample timing", sample_timing });
	
	controller_load_shell_add();

	shell_intro = "Dwingeloo Telescope controller\n";
	shell_prompt = "DT>";
	
	shell_server_start(CTRL_SHELL_PORT, 10);

	log_server_start(CTRL_LOG_PORT);

	asprintf(&dot_filename, "%s.dot", ctrl_filename);
	controller_dumpdot(dot_filename);
	free(dot_filename);

	/* Start 'sample' */

	controller_block_sample_init();

	printf("Starting sample thread\n");
	controller_sample_start();

	while (1) {
		float az_pos;
		float el_pos;
		float el_tor;

		if (controller_block_output_get_float("elevation_input_matrix", "out0", &el_pos))
			log_send(LOG_T_ERROR, "Getting elevation_input_matrix.out0 failed\n");
		if (controller_block_output_get_float("elevation_input_matrix", "out1", &el_tor))
			log_send(LOG_T_ERROR, "Getting elevation_input_matrix.out1 failed\n");
		if (controller_block_output_get_float("dt_az", "position", &az_pos))
			log_send(LOG_T_ERROR, "Getting dt_az.position failed\n");

		log_send(LOG_T_INFO, "Elevation: %e (Torsion: %e) Azimuth: %e",
		    el_pos, el_tor, az_pos);
		
		/* Log once every 15 minutes */
		sleep(15 * 60);
	}

	return 0;
}