FreeCalypso > hg > fc-tourmaline
comparison src/cs/services/vibr/vibr_api.c @ 294:e17bdedfbf2b
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 } |