ec_cmd_fprd.c

#include "../include/xgeneral.h"
#include "ethercattype.h"
#include "fsm_slave.h"
#include "ecs_slave.h"
#include "ec_regs.h"
#include "ec_sii.h"

/** Configured Address Read */
void ec_cmd_fprd(ecat_slave *ecs,uint8_t *dgram_ec)
{
	uint16_t ado, adp;
	uint16_t datalen = __ec_dgram_dlength(dgram_ec);
	uint8_t *data = __ec_dgram_data(dgram_ec);

	ado = __ec_dgram_ado(dgram_ec);
	adp = __ec_dgram_adp(dgram_ec);
	if (adp != ec_station_address(ecs)) {
		goto FPRD_OUT;
	}
	if (datalen == 0) {
		goto FPRD_OUT;
	}
	__ec_inc_wkc__(dgram_ec);
	ec_get_ado(ecs, ado, data, datalen);
	if (ado == ECT_REG_EEPSTAT){
		ec_sii_rw(ecs, data, datalen);
	}
FPRD_OUT:
        __set_fsm_state(ecs, ecs_process_next_dgram);
}