GEX core repository.
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.
 
 
 
 
gex-core/comm/msg_responses.c

114 lines
2.4 KiB

//
// Created by MightyPork on 2017/12/22.
//
#include "platform.h"
#include "messages.h"
#include "msg_responses.h"
#include "payload_builder.h"
void com_respond_snprintf(TF_ID frame_id, TF_TYPE type, const char *format, ...)
{
char buf[ERR_MSG_STR_LEN];
va_list args;
va_start(args, format);
uint32_t len = (uint32_t) fixup_vsnprintf(&buf[0], ERR_MSG_STR_LEN, format, args);
va_end(args);
com_respond_buf(frame_id, type, (const uint8_t *) buf, len);
}
void com_respond_buf(TF_ID frame_id, TF_TYPE type, const uint8_t *buf, uint32_t len)
{
TF_Msg msg = {
.type = type,
.frame_id = frame_id,
.data = buf,
.len = (TF_LEN) len,
};
TF_Respond(comm, &msg);
}
void com_respond_pb(TF_ID frame_id, TF_TYPE type, PayloadBuilder *pb)
{
uint32_t len;
uint8_t *buf = pb_close(pb, &len);
com_respond_buf(frame_id, type, buf, len);
}
void com_respond_ok(TF_ID frame_id)
{
com_respond_buf(frame_id, MSG_SUCCESS, NULL, 0);
}
void com_send_pb(TF_TYPE type, PayloadBuilder *pb)
{
uint32_t len;
uint8_t *buf = pb_close(pb, &len);
com_send_buf(type, buf, len);
}
void com_send_buf(TF_TYPE type, const uint8_t *buf, uint32_t len)
{
TF_Msg msg = {
.type = MSG_UNIT_REPORT,
.data = buf,
.len = (TF_LEN) len,
.type = type,
};
TF_Send(comm, &msg); // no listener
}
void com_respond_str(TF_TYPE type, TF_ID frame_id, const char *str)
{
com_respond_buf(frame_id, type, (const uint8_t *) str, (uint32_t) strlen(str));
}
// ---------------------------------------------------------------------------
static void respond_err(TF_ID frame_id, const char *message)
{
com_respond_str(MSG_ERROR, frame_id, message);
}
void com_respond_bad_cmd(TF_ID frame_id)
{
respond_err(frame_id, "BAD COMMAND");
}
void com_respond_error(TF_ID frame_id, error_t error)
{
if (error == E_SUCCESS)
com_respond_ok(frame_id);
else
respond_err(frame_id, error_get_message(error));
}
// ---------------------------------------------------------------------------
void com_respond_u8(TF_ID frame_id, uint8_t d)
{
com_respond_buf(frame_id, MSG_SUCCESS, (const uint8_t *) &d, 1);
}
void com_respond_u16(TF_ID frame_id, uint16_t d)
{
com_respond_buf(frame_id, MSG_SUCCESS, (const uint8_t *) &d, 2);
}
void com_respond_u32(TF_ID frame_id, uint32_t d)
{
com_respond_buf(frame_id, MSG_SUCCESS, (const uint8_t *) &d, 4);
}