FreeCalypso > hg > fc-tourmaline

comparison src/cs/services/vibr/vibr_api.c @ 294:e17bdedfbf2b

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
VIBR SWE initial implementation
author Mychaela Falconia <falcon@freecalypso.org>
date Sun, 27 Mar 2022 08:46:10 +0000
parents
children
comparison
equal deleted inserted replaced
293:2d7d95e7f9c2 294:e17bdedfbf2b
1 /*
2 * The implementation of our external API functions lives here.
3 */
4
5 #include "vibr/vibr_api.h"
6 #include "vibr/vibr_env.h"
7 #include "vibr/vibr_messages_i.h"
8 #include "rv/rv_general.h"
9 #include "rvf/rvf_api.h"
10 #include "rvm/rvm_use_id_list.h"
11
12 T_RV_RET vibr_pulse_train_start(UINT8 num_pulses, UINT8 vibr_level)
13 {
14 struct vibr_start_msg *msg;
15
16 if (!vibr_env)
17 return RV_NOT_READY;
18 if (rvf_get_buf(vibr_env->prim_id, sizeof(struct vibr_start_msg),
19 (T_RVF_BUFFER **)&msg) == RVF_RED) {
20 rvf_send_trace(
21 "rvf_get_buf() failed in vibr_pulse_train_start()", 48,
22 NULL_PARAM, RV_TRACE_LEVEL_ERROR, VIBR_USE_ID);
23 return RV_MEMORY_ERR;
24 }
25 msg->hdr.msg_id = VIBR_START_REQ;
26 msg->hdr.src_addr_id = vibr_env->addr_id;
27 msg->hdr.dest_addr_id = vibr_env->addr_id;
28 msg->hdr.callback_func = NULL;
29 msg->num_pulses = num_pulses;
30 msg->vibr_level = vibr_level;
31 if (rvf_send_msg(vibr_env->addr_id, msg) != RV_OK) {
32 rvf_send_trace("vibr_pulse_train_start(): Send failed!", 38,
33 NULL_PARAM, RV_TRACE_LEVEL_ERROR, VIBR_USE_ID);
34 rvf_free_buf(msg);
35 return RV_INTERNAL_ERR;
36 }
37 return RV_OK;
38 }
39
40 T_RV_RET vibr_pulse_train_stop(void)
41 {
42 struct vibr_stop_msg *msg;
43
44 if (!vibr_env)
45 return RV_NOT_READY;
46 if (rvf_get_buf(vibr_env->prim_id, sizeof(struct vibr_stop_msg),
47 (T_RVF_BUFFER **)&msg) == RVF_RED) {
48 rvf_send_trace(
49 "rvf_get_buf() failed in vibr_pulse_train_stop()", 47,
50 NULL_PARAM, RV_TRACE_LEVEL_ERROR, VIBR_USE_ID);
51 return RV_MEMORY_ERR;
52 }
53 msg->hdr.msg_id = VIBR_STOP_REQ;
54 msg->hdr.src_addr_id = vibr_env->addr_id;
55 msg->hdr.dest_addr_id = vibr_env->addr_id;
56 msg->hdr.callback_func = NULL;
57 if (rvf_send_msg(vibr_env->addr_id, msg) != RV_OK) {
58 rvf_send_trace("vibr_pulse_train_stop(): Send failed!", 37,
59 NULL_PARAM, RV_TRACE_LEVEL_ERROR, VIBR_USE_ID);
60 rvf_free_buf(msg);
61 return RV_INTERNAL_ERR;
62 }
63 return RV_OK;
64 }