/*
 * P60DockTestTask.h
 *
 *  Created on: 18.11.2020
 *      Author: Jakob Meier
 */

#ifndef TEST_TESTTASKS_P60DOCKTESTTASK_H_
#define TEST_TESTTASKS_P60DOCKTESTTASK_H_

#include <fsfw/returnvalues/HasReturnvaluesIF.h>
#include <fsfw/tasks/ExecutableObjectIF.h>
#include <fsfw/objectmanager/SystemObject.h>

#include <p60dock.h>
#include <gs/param/internal/types.h>
#include <csp/csp.h>
#include <csp/interfaces/csp_if_can.h>


class P60DockTestTask: public SystemObject,
		public ExecutableObjectIF,
		public HasReturnvaluesIF {
public:
	P60DockTestTask(object_id_t objectId_);
	virtual ~P60DockTestTask();

	virtual ReturnValue_t performOperation(uint8_t operationCode = 0);

private:
	/* Interface struct for csp protocol stack */
	csp_iface_t csp_if;
	uint8_t p60dockAddress = 4;
	uint8_t CSP_PING = 1;
	uint8_t cspAddress = 1;
	const char* canIf = "can0";
	int bitrate = 1000; // bitrate of can
	int promisc = 0; // set to 0 to enable filter mode

	uint8_t hk_mem[P60DOCK_HK_SIZE];
	uint8_t p60dock_node = 4;
	gs_param_table_instance_t node_hk;

	ReturnValue_t sendPacket(void);
	ReturnValue_t initializeCSPStack(void);
	ReturnValue_t getParameters(void);

};

#endif /* TEST_TESTTASKS_P60DOCKTESTTASK_H_ */