// // 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); }