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 "mbed.h"
be_bryan 0:b74591d5ab33 17 #include "Arguments.h"
be_bryan 0:b74591d5ab33 18 #include "pinmap.h"
be_bryan 0:b74591d5ab33 19
be_bryan 0:b74591d5ab33 20 using namespace std;
be_bryan 0:b74591d5ab33 21
be_bryan 0:b74591d5ab33 22 namespace mbed {
be_bryan 0:b74591d5ab33 23
be_bryan 0:b74591d5ab33 24 Arguments::Arguments(const char* rqs) {
be_bryan 0:b74591d5ab33 25 obj_name = NULL;
be_bryan 0:b74591d5ab33 26 method_name = NULL;
be_bryan 0:b74591d5ab33 27 argc = 0;
be_bryan 0:b74591d5ab33 28
be_bryan 0:b74591d5ab33 29 // This copy can be removed if we can assume the request string is
be_bryan 0:b74591d5ab33 30 // persistent and writable for the duration of the call
be_bryan 0:b74591d5ab33 31 strcpy(request, rqs);
be_bryan 0:b74591d5ab33 32
be_bryan 0:b74591d5ab33 33 // Initial '/'
be_bryan 0:b74591d5ab33 34 char* p = request;
be_bryan 0:b74591d5ab33 35 if (*p != '/') return;
be_bryan 0:b74591d5ab33 36 p++;
be_bryan 0:b74591d5ab33 37
be_bryan 0:b74591d5ab33 38 // Object Name
be_bryan 0:b74591d5ab33 39 p = search_arg(&obj_name, p, '/');
be_bryan 0:b74591d5ab33 40 if (p == NULL) return;
be_bryan 0:b74591d5ab33 41
be_bryan 0:b74591d5ab33 42 // Method Name
be_bryan 0:b74591d5ab33 43 p = search_arg(&method_name, p, ' ');
be_bryan 0:b74591d5ab33 44 if (p == NULL) return;
be_bryan 0:b74591d5ab33 45
be_bryan 0:b74591d5ab33 46 // Arguments
be_bryan 0:b74591d5ab33 47 while (true) {
be_bryan 0:b74591d5ab33 48 argv[argc] = NULL;
be_bryan 0:b74591d5ab33 49 p = search_arg(&argv[argc], p, ' ');
be_bryan 0:b74591d5ab33 50 if (argv[argc] != NULL) argc++;
be_bryan 0:b74591d5ab33 51 if (p == NULL) break;
be_bryan 0:b74591d5ab33 52 }
be_bryan 0:b74591d5ab33 53
be_bryan 0:b74591d5ab33 54 index = -1;
be_bryan 0:b74591d5ab33 55 }
be_bryan 0:b74591d5ab33 56
be_bryan 0:b74591d5ab33 57 char* Arguments::search_arg(char **arg, char *p, char next_sep) {
be_bryan 0:b74591d5ab33 58 char *s = p;
be_bryan 0:b74591d5ab33 59 while (true) {
be_bryan 0:b74591d5ab33 60 if ((*p == '/') || (*p == ' ') || (*p == '\n') || (*p == '\0')) break;
be_bryan 0:b74591d5ab33 61 p++;
be_bryan 0:b74591d5ab33 62 }
be_bryan 0:b74591d5ab33 63 if (p == s) return NULL;
be_bryan 0:b74591d5ab33 64 *arg = s;
be_bryan 0:b74591d5ab33 65 char separator = *p;
be_bryan 0:b74591d5ab33 66 *p = '\0';
be_bryan 0:b74591d5ab33 67 p++;
be_bryan 0:b74591d5ab33 68 return (separator == next_sep) ? (p) : (NULL);
be_bryan 0:b74591d5ab33 69 }
be_bryan 0:b74591d5ab33 70
be_bryan 0:b74591d5ab33 71 template<> PinName Arguments::getArg<PinName>(void) {
be_bryan 0:b74591d5ab33 72 index++;
be_bryan 0:b74591d5ab33 73 return parse_pins(argv[index]);
be_bryan 0:b74591d5ab33 74 }
be_bryan 0:b74591d5ab33 75
be_bryan 0:b74591d5ab33 76 template<> int Arguments::getArg<int>(void) {
be_bryan 0:b74591d5ab33 77 index++;
be_bryan 0:b74591d5ab33 78 char *pEnd;
be_bryan 0:b74591d5ab33 79 return strtol(argv[index], &pEnd, 10);
be_bryan 0:b74591d5ab33 80 }
be_bryan 0:b74591d5ab33 81
be_bryan 0:b74591d5ab33 82 template<> const char* Arguments::getArg<const char*>(void) {
be_bryan 0:b74591d5ab33 83 index++;
be_bryan 0:b74591d5ab33 84 return argv[index];
be_bryan 0:b74591d5ab33 85 }
be_bryan 0:b74591d5ab33 86
be_bryan 0:b74591d5ab33 87 template<> char Arguments::getArg<char>(void) {
be_bryan 0:b74591d5ab33 88 index++;
be_bryan 0:b74591d5ab33 89 return *argv[index];
be_bryan 0:b74591d5ab33 90 }
be_bryan 0:b74591d5ab33 91
be_bryan 0:b74591d5ab33 92 template<> double Arguments::getArg<double>(void) {
be_bryan 0:b74591d5ab33 93 index++;
be_bryan 0:b74591d5ab33 94 return atof(argv[index]);
be_bryan 0:b74591d5ab33 95 }
be_bryan 0:b74591d5ab33 96
be_bryan 0:b74591d5ab33 97 template<> float Arguments::getArg<float>(void) {
be_bryan 0:b74591d5ab33 98 index++;
be_bryan 0:b74591d5ab33 99 return atof(argv[index]);
be_bryan 0:b74591d5ab33 100 }
be_bryan 0:b74591d5ab33 101
be_bryan 0:b74591d5ab33 102 Reply::Reply(char* r) {
be_bryan 0:b74591d5ab33 103 first = true;
be_bryan 0:b74591d5ab33 104 *r = '\0';
be_bryan 0:b74591d5ab33 105 reply = r;
be_bryan 0:b74591d5ab33 106 }
be_bryan 0:b74591d5ab33 107
be_bryan 0:b74591d5ab33 108 void Reply::separator(void) {
be_bryan 0:b74591d5ab33 109 if (first) {
be_bryan 0:b74591d5ab33 110 first = false;
be_bryan 0:b74591d5ab33 111 } else {
be_bryan 0:b74591d5ab33 112 *reply = ' '; reply++;
be_bryan 0:b74591d5ab33 113 }
be_bryan 0:b74591d5ab33 114 }
be_bryan 0:b74591d5ab33 115
be_bryan 0:b74591d5ab33 116 template<> void Reply::putData<const char*>(const char* s) {
be_bryan 0:b74591d5ab33 117 separator();
be_bryan 0:b74591d5ab33 118 reply += sprintf(reply, "%s", s);
be_bryan 0:b74591d5ab33 119 }
be_bryan 0:b74591d5ab33 120
be_bryan 0:b74591d5ab33 121 template<> void Reply::putData<char*>(char* s) {
be_bryan 0:b74591d5ab33 122 separator();
be_bryan 0:b74591d5ab33 123 reply += sprintf(reply, "%s", s);
be_bryan 0:b74591d5ab33 124 }
be_bryan 0:b74591d5ab33 125
be_bryan 0:b74591d5ab33 126 template<> void Reply::putData<char>(char c) {
be_bryan 0:b74591d5ab33 127 separator();
be_bryan 0:b74591d5ab33 128 reply += sprintf(reply, "%c", c);
be_bryan 0:b74591d5ab33 129 }
be_bryan 0:b74591d5ab33 130
be_bryan 0:b74591d5ab33 131 template<> void Reply::putData<int>(int v) {
be_bryan 0:b74591d5ab33 132 separator();
be_bryan 0:b74591d5ab33 133 reply += sprintf(reply, "%d", v);
be_bryan 0:b74591d5ab33 134 }
be_bryan 0:b74591d5ab33 135
be_bryan 0:b74591d5ab33 136 template<> void Reply::putData<float>(float f) {
be_bryan 0:b74591d5ab33 137 separator();
be_bryan 0:b74591d5ab33 138 reply += sprintf(reply, "%.17g", f);
be_bryan 0:b74591d5ab33 139 }
be_bryan 0:b74591d5ab33 140
be_bryan 0:b74591d5ab33 141 } // namespace mbed