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.
85 lines
2.3 KiB
85 lines
2.3 KiB
7 years ago
|
//
|
||
|
|
// Created by MightyPork on 2017/11/25.
|
||
|
|
//
|
||
|
|
|
||
|
|
#include "unit_base.h"
|
||
|
|
#include "unit_fcap.h"
|
||
|
|
|
||
|
|
#define FCAP_INTERNAL
|
||
|
|
#include "_fcap_internal.h"
|
||
|
|
|
||
|
|
// ------------------------------------------------------------------------
|
||
|
|
|
||
|
|
enum FcapCmd_ {
|
||
|
|
CMD_STOP = 0,
|
||
|
|
CMD_PWM_CONT_START = 1,
|
||
|
|
CMD_PWM_BURST_START = 2,
|
||
|
|
CMD_PWM_CONT_READ = 10,
|
||
|
|
};
|
||
|
|
|
||
|
|
/** Handle a request message */
|
||
|
|
static error_t UFCAP_handleRequest(Unit *unit, TF_ID frame_id, uint8_t command, PayloadParser *pp)
|
||
|
|
{
|
||
|
|
struct priv *priv = unit->data;
|
||
|
|
|
||
|
|
switch (command) {
|
||
|
|
case CMD_STOP:
|
||
|
|
UFCAP_SwitchMode(unit, OPMODE_IDLE);
|
||
|
|
return E_SUCCESS;
|
||
|
|
|
||
|
|
case CMD_PWM_CONT_START:
|
||
|
|
if (priv->opmode == OPMODE_PWM_CONT) return E_SUCCESS; // no-op
|
||
|
|
if (priv->opmode != OPMODE_IDLE) return E_BUSY;
|
||
|
|
|
||
|
|
UFCAP_SwitchMode(unit, OPMODE_PWM_CONT);
|
||
|
|
return E_SUCCESS;
|
||
|
|
|
||
|
|
case CMD_PWM_BURST_START:
|
||
|
|
if (priv->opmode != OPMODE_IDLE) return E_BAD_MODE;
|
||
|
|
|
||
|
|
uint16_t count = pp_u16(pp);
|
||
|
|
priv->pwm_burst.n_target = count;
|
||
|
|
priv->request_id = frame_id;
|
||
|
|
UFCAP_SwitchMode(unit, OPMODE_PWM_BURST);
|
||
|
|
return E_SUCCESS;
|
||
|
|
|
||
|
|
case CMD_PWM_CONT_READ:
|
||
|
|
if (priv->opmode != OPMODE_PWM_CONT) {
|
||
|
|
return E_BAD_MODE;
|
||
|
|
}
|
||
|
|
if (priv->pwm_cont.last_period == 0) {
|
||
|
|
return E_BUSY;
|
||
|
|
}
|
||
|
|
|
||
|
|
PayloadBuilder pb = pb_start(unit_tmp512, UNIT_TMP_LEN, NULL);
|
||
|
|
pb_u16(&pb, PLAT_AHB_MHZ);
|
||
|
|
pb_u32(&pb, priv->pwm_cont.last_period);
|
||
|
|
pb_u32(&pb, priv->pwm_cont.last_ontime);
|
||
|
|
|
||
|
|
com_respond_pb(frame_id, MSG_SUCCESS, &pb);
|
||
|
|
return E_SUCCESS;
|
||
|
|
|
||
|
|
default:
|
||
|
|
return E_UNKNOWN_COMMAND;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
// ------------------------------------------------------------------------
|
||
|
|
|
||
|
|
/** Frequency capture */
|
||
|
|
const UnitDriver UNIT_FCAP = {
|
||
|
|
.name = "FCAP",
|
||
|
|
.description = "Frequency and pulse measurement",
|
||
|
|
// Settings
|
||
|
|
.preInit = UFCAP_preInit,
|
||
|
|
.cfgLoadBinary = UFCAP_loadBinary,
|
||
|
|
.cfgWriteBinary = UFCAP_writeBinary,
|
||
|
|
.cfgLoadIni = UFCAP_loadIni,
|
||
|
|
.cfgWriteIni = UFCAP_writeIni,
|
||
|
|
// Init
|
||
|
|
.init = UFCAP_init,
|
||
|
|
.deInit = UFCAP_deInit,
|
||
|
|
// Function
|
||
|
|
.handleRequest = UFCAP_handleRequest,
|
||
|
|
};
|