mbed-os

Dependents:   cobaLCDJoyMotor_Thread odometry_omni_3roda_v3 odometry_omni_3roda_v1 odometry_omni_3roda_v2 ... more

Committer:
be_bryan
Date:
Mon Dec 11 17:54:04 2017 +0000
Revision:
0:b74591d5ab33
motor ++

Who changed what in which revision?

UserRevisionLine numberNew contents of line
be_bryan 0:b74591d5ab33 1 /* mbed Microcontroller Library
be_bryan 0:b74591d5ab33 2 * Copyright (c) 2006-2013 ARM Limited
be_bryan 0:b74591d5ab33 3 *
be_bryan 0:b74591d5ab33 4 * Licensed under the Apache License, Version 2.0 (the "License");
be_bryan 0:b74591d5ab33 5 * you may not use this file except in compliance with the License.
be_bryan 0:b74591d5ab33 6 * You may obtain a copy of the License at
be_bryan 0:b74591d5ab33 7 *
be_bryan 0:b74591d5ab33 8 * http://www.apache.org/licenses/LICENSE-2.0
be_bryan 0:b74591d5ab33 9 *
be_bryan 0:b74591d5ab33 10 * Unless required by applicable law or agreed to in writing, software
be_bryan 0:b74591d5ab33 11 * distributed under the License is distributed on an "AS IS" BASIS,
be_bryan 0:b74591d5ab33 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
be_bryan 0:b74591d5ab33 13 * See the License for the specific language governing permissions and
be_bryan 0:b74591d5ab33 14 * limitations under the License.
be_bryan 0:b74591d5ab33 15 */
be_bryan 0:b74591d5ab33 16 #include "rpc.h"
be_bryan 0:b74591d5ab33 17
be_bryan 0:b74591d5ab33 18 using namespace std;
be_bryan 0:b74591d5ab33 19
be_bryan 0:b74591d5ab33 20 namespace mbed {
be_bryan 0:b74591d5ab33 21
be_bryan 0:b74591d5ab33 22 RPC::RPC(const char *name) {
be_bryan 0:b74591d5ab33 23 _from_construct = false;
be_bryan 0:b74591d5ab33 24 if (name != NULL) {
be_bryan 0:b74591d5ab33 25 _name = new char[strlen(name) + 1];
be_bryan 0:b74591d5ab33 26 strcpy(_name, name);
be_bryan 0:b74591d5ab33 27 } else {
be_bryan 0:b74591d5ab33 28 _name = new char[12];
be_bryan 0:b74591d5ab33 29 sprintf(_name, "obj%p", this);
be_bryan 0:b74591d5ab33 30 }
be_bryan 0:b74591d5ab33 31 // put this object at head of the list
be_bryan 0:b74591d5ab33 32 _next = _head;
be_bryan 0:b74591d5ab33 33 _head = this;
be_bryan 0:b74591d5ab33 34 }
be_bryan 0:b74591d5ab33 35
be_bryan 0:b74591d5ab33 36 RPC::~RPC() {
be_bryan 0:b74591d5ab33 37 // remove this object from the list
be_bryan 0:b74591d5ab33 38 if (_head == this) { // first in the list, so just drop me
be_bryan 0:b74591d5ab33 39 _head = _next;
be_bryan 0:b74591d5ab33 40 } else { // find the object before me, then drop me
be_bryan 0:b74591d5ab33 41 RPC* p = _head;
be_bryan 0:b74591d5ab33 42 while (p->_next != this) {
be_bryan 0:b74591d5ab33 43 p = p->_next;
be_bryan 0:b74591d5ab33 44 }
be_bryan 0:b74591d5ab33 45 p->_next = _next;
be_bryan 0:b74591d5ab33 46 }
be_bryan 0:b74591d5ab33 47 }
be_bryan 0:b74591d5ab33 48
be_bryan 0:b74591d5ab33 49 const rpc_method *RPC::get_rpc_methods() {
be_bryan 0:b74591d5ab33 50 static const rpc_method methods[] = {
be_bryan 0:b74591d5ab33 51 {"delete", rpc_method_caller<RPC, &RPC::delete_self> },
be_bryan 0:b74591d5ab33 52 RPC_METHOD_END
be_bryan 0:b74591d5ab33 53 };
be_bryan 0:b74591d5ab33 54 return methods;
be_bryan 0:b74591d5ab33 55 }
be_bryan 0:b74591d5ab33 56
be_bryan 0:b74591d5ab33 57 RPC *RPC::lookup(const char *name) {
be_bryan 0:b74591d5ab33 58 size_t len = strlen(name);
be_bryan 0:b74591d5ab33 59 for (RPC *p = _head; p != NULL; p = p->_next) {
be_bryan 0:b74591d5ab33 60 /* Check that p->_name matches name and is the correct length */
be_bryan 0:b74591d5ab33 61 if (strncmp(p->_name, name, len) == 0 && (strlen(p->_name) == len)) {
be_bryan 0:b74591d5ab33 62 return p;
be_bryan 0:b74591d5ab33 63 }
be_bryan 0:b74591d5ab33 64 }
be_bryan 0:b74591d5ab33 65 return NULL;
be_bryan 0:b74591d5ab33 66 }
be_bryan 0:b74591d5ab33 67
be_bryan 0:b74591d5ab33 68 void RPC::delete_self() {
be_bryan 0:b74591d5ab33 69 delete[] _name;
be_bryan 0:b74591d5ab33 70 if (_from_construct) {
be_bryan 0:b74591d5ab33 71 delete this;
be_bryan 0:b74591d5ab33 72 }
be_bryan 0:b74591d5ab33 73 }
be_bryan 0:b74591d5ab33 74
be_bryan 0:b74591d5ab33 75 void RPC::list_objs(Arguments *args, Reply *result) {
be_bryan 0:b74591d5ab33 76 for (RPC *ptr = RPC::_head; ptr != NULL; ptr = ptr->_next) {
be_bryan 0:b74591d5ab33 77 if (ptr->_from_construct) {
be_bryan 0:b74591d5ab33 78 result->putData<const char*>(ptr->_name);
be_bryan 0:b74591d5ab33 79 }
be_bryan 0:b74591d5ab33 80 }
be_bryan 0:b74591d5ab33 81 }
be_bryan 0:b74591d5ab33 82
be_bryan 0:b74591d5ab33 83 void RPC::clear(Arguments*, Reply*) {
be_bryan 0:b74591d5ab33 84 RPC *ptr = RPC::_head;
be_bryan 0:b74591d5ab33 85 while (ptr != NULL) {
be_bryan 0:b74591d5ab33 86 RPC *tmp = ptr;
be_bryan 0:b74591d5ab33 87 ptr = ptr->_next;
be_bryan 0:b74591d5ab33 88 delete[] tmp->_name;
be_bryan 0:b74591d5ab33 89 if (tmp->_from_construct) {
be_bryan 0:b74591d5ab33 90 delete tmp;
be_bryan 0:b74591d5ab33 91 }
be_bryan 0:b74591d5ab33 92 }
be_bryan 0:b74591d5ab33 93 }
be_bryan 0:b74591d5ab33 94
be_bryan 0:b74591d5ab33 95 const rpc_function RPC::_RPC_funcs[] = {
be_bryan 0:b74591d5ab33 96 {"clear", &RPC::clear },
be_bryan 0:b74591d5ab33 97 { "objects", &RPC::list_objs },
be_bryan 0:b74591d5ab33 98 RPC_METHOD_END
be_bryan 0:b74591d5ab33 99 };
be_bryan 0:b74591d5ab33 100
be_bryan 0:b74591d5ab33 101 rpc_class RPC::_RPC_class = { "RPC", _RPC_funcs, NULL };
be_bryan 0:b74591d5ab33 102
be_bryan 0:b74591d5ab33 103 RPC *RPC::_head = NULL;
be_bryan 0:b74591d5ab33 104
be_bryan 0:b74591d5ab33 105 rpc_class *RPC::_classes = &_RPC_class;
be_bryan 0:b74591d5ab33 106
be_bryan 0:b74591d5ab33 107 bool RPC::call(const char *request, char *reply) {
be_bryan 0:b74591d5ab33 108 if (request == NULL) return false;
be_bryan 0:b74591d5ab33 109
be_bryan 0:b74591d5ab33 110 Arguments args(request);
be_bryan 0:b74591d5ab33 111 Reply r(reply);
be_bryan 0:b74591d5ab33 112
be_bryan 0:b74591d5ab33 113 /* If there's no name print object and class names to result */
be_bryan 0:b74591d5ab33 114 if (args.obj_name == NULL) {
be_bryan 0:b74591d5ab33 115 for (RPC *p = RPC::_head; p != NULL; p = p->_next) {
be_bryan 0:b74591d5ab33 116 r.putData<const char*>(p->_name);
be_bryan 0:b74591d5ab33 117 }
be_bryan 0:b74591d5ab33 118 for (rpc_class *c = RPC::_classes; c != NULL; c = c->next) {
be_bryan 0:b74591d5ab33 119 r.putData<const char*>(c->name);
be_bryan 0:b74591d5ab33 120 }
be_bryan 0:b74591d5ab33 121 return true;
be_bryan 0:b74591d5ab33 122 }
be_bryan 0:b74591d5ab33 123
be_bryan 0:b74591d5ab33 124 /* First try matching an instance */
be_bryan 0:b74591d5ab33 125 RPC *p = lookup(args.obj_name);
be_bryan 0:b74591d5ab33 126 if (p != NULL) {
be_bryan 0:b74591d5ab33 127 /* Get the list of methods we support */
be_bryan 0:b74591d5ab33 128 const rpc_method *cur_method = p->get_rpc_methods();
be_bryan 0:b74591d5ab33 129
be_bryan 0:b74591d5ab33 130 /* When there's no method print method names to result */
be_bryan 0:b74591d5ab33 131 if (args.method_name == NULL) {
be_bryan 0:b74591d5ab33 132 while (true) {
be_bryan 0:b74591d5ab33 133 for (; cur_method->name != NULL; cur_method++) {
be_bryan 0:b74591d5ab33 134 r.putData<const char*>(cur_method->name);
be_bryan 0:b74591d5ab33 135 }
be_bryan 0:b74591d5ab33 136
be_bryan 0:b74591d5ab33 137 /* write_name_arr's args are references, so result and cur_method will have changed */
be_bryan 0:b74591d5ab33 138 if (cur_method->super != 0) {
be_bryan 0:b74591d5ab33 139 cur_method = cur_method->super(p);
be_bryan 0:b74591d5ab33 140 } else {
be_bryan 0:b74591d5ab33 141 return true;
be_bryan 0:b74591d5ab33 142 }
be_bryan 0:b74591d5ab33 143 }
be_bryan 0:b74591d5ab33 144 }
be_bryan 0:b74591d5ab33 145
be_bryan 0:b74591d5ab33 146 /* Look through the methods for the one whose name matches */
be_bryan 0:b74591d5ab33 147 while (true) {
be_bryan 0:b74591d5ab33 148 for (; cur_method->name != NULL; cur_method++) {
be_bryan 0:b74591d5ab33 149 if (strcmp(cur_method->name, args.method_name) == 0) {
be_bryan 0:b74591d5ab33 150 (cur_method->method_caller)(p, &args, &r);
be_bryan 0:b74591d5ab33 151 return true;
be_bryan 0:b74591d5ab33 152 }
be_bryan 0:b74591d5ab33 153 }
be_bryan 0:b74591d5ab33 154
be_bryan 0:b74591d5ab33 155 if (cur_method->super != 0) {
be_bryan 0:b74591d5ab33 156 cur_method = cur_method->super(p);
be_bryan 0:b74591d5ab33 157 } else {
be_bryan 0:b74591d5ab33 158 /* end of methods and no match */
be_bryan 0:b74591d5ab33 159 return false;
be_bryan 0:b74591d5ab33 160 }
be_bryan 0:b74591d5ab33 161
be_bryan 0:b74591d5ab33 162 }
be_bryan 0:b74591d5ab33 163 }
be_bryan 0:b74591d5ab33 164
be_bryan 0:b74591d5ab33 165 /* Then try a class */
be_bryan 0:b74591d5ab33 166 for (const rpc_class *q = _classes; q != NULL; q = q->next) {
be_bryan 0:b74591d5ab33 167 if (strcmp(q->name, args.obj_name) == 0) {
be_bryan 0:b74591d5ab33 168 /* Matched the class name, so get its functions */
be_bryan 0:b74591d5ab33 169 const rpc_function *cur_func = q->static_functions;
be_bryan 0:b74591d5ab33 170 if (args.method_name == NULL) {
be_bryan 0:b74591d5ab33 171 for (; cur_func->name != NULL; cur_func++) {
be_bryan 0:b74591d5ab33 172 r.putData<const char*>(cur_func->name);
be_bryan 0:b74591d5ab33 173 }
be_bryan 0:b74591d5ab33 174 return true;
be_bryan 0:b74591d5ab33 175 } else {
be_bryan 0:b74591d5ab33 176 /* Otherwise call the appropriate function */
be_bryan 0:b74591d5ab33 177 for (; cur_func->name != NULL; cur_func++) {
be_bryan 0:b74591d5ab33 178 if (strcmp(cur_func->name, args.method_name) == 0) {
be_bryan 0:b74591d5ab33 179 (cur_func->function_caller)(&args, &r);
be_bryan 0:b74591d5ab33 180 return true;
be_bryan 0:b74591d5ab33 181 }
be_bryan 0:b74591d5ab33 182 }
be_bryan 0:b74591d5ab33 183 return false;
be_bryan 0:b74591d5ab33 184 }
be_bryan 0:b74591d5ab33 185 }
be_bryan 0:b74591d5ab33 186 }
be_bryan 0:b74591d5ab33 187
be_bryan 0:b74591d5ab33 188 return false;
be_bryan 0:b74591d5ab33 189 }
be_bryan 0:b74591d5ab33 190
be_bryan 0:b74591d5ab33 191 } // namespace mbed