takashi kadono / Mbed OS Nucleo_446

Dependencies:   ssd1331

Committer:
kadonotakashi
Date:
Thu Oct 11 02:27:46 2018 +0000
Revision:
3:f3764f852aa8
Parent:
0:8fdf9a60065b
Nucreo 446 + SSD1331 test version;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kadonotakashi 0:8fdf9a60065b 1 /* mbed Microcontroller Library
kadonotakashi 0:8fdf9a60065b 2 * Copyright (c) 2006-2013 ARM Limited
kadonotakashi 0:8fdf9a60065b 3 *
kadonotakashi 0:8fdf9a60065b 4 * Licensed under the Apache License, Version 2.0 (the "License");
kadonotakashi 0:8fdf9a60065b 5 * you may not use this file except in compliance with the License.
kadonotakashi 0:8fdf9a60065b 6 * You may obtain a copy of the License at
kadonotakashi 0:8fdf9a60065b 7 *
kadonotakashi 0:8fdf9a60065b 8 * http://www.apache.org/licenses/LICENSE-2.0
kadonotakashi 0:8fdf9a60065b 9 *
kadonotakashi 0:8fdf9a60065b 10 * Unless required by applicable law or agreed to in writing, software
kadonotakashi 0:8fdf9a60065b 11 * distributed under the License is distributed on an "AS IS" BASIS,
kadonotakashi 0:8fdf9a60065b 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
kadonotakashi 0:8fdf9a60065b 13 * See the License for the specific language governing permissions and
kadonotakashi 0:8fdf9a60065b 14 * limitations under the License.
kadonotakashi 0:8fdf9a60065b 15 */
kadonotakashi 0:8fdf9a60065b 16 #include "mbed.h"
kadonotakashi 0:8fdf9a60065b 17 #include "Arguments.h"
kadonotakashi 0:8fdf9a60065b 18 #include "pinmap.h"
kadonotakashi 0:8fdf9a60065b 19
kadonotakashi 0:8fdf9a60065b 20 using namespace std;
kadonotakashi 0:8fdf9a60065b 21
kadonotakashi 0:8fdf9a60065b 22 namespace mbed {
kadonotakashi 0:8fdf9a60065b 23
kadonotakashi 0:8fdf9a60065b 24 Arguments::Arguments(const char* rqs) {
kadonotakashi 0:8fdf9a60065b 25 obj_name = NULL;
kadonotakashi 0:8fdf9a60065b 26 method_name = NULL;
kadonotakashi 0:8fdf9a60065b 27 argc = 0;
kadonotakashi 0:8fdf9a60065b 28
kadonotakashi 0:8fdf9a60065b 29 // This copy can be removed if we can assume the request string is
kadonotakashi 0:8fdf9a60065b 30 // persistent and writable for the duration of the call
kadonotakashi 0:8fdf9a60065b 31 strcpy(request, rqs);
kadonotakashi 0:8fdf9a60065b 32
kadonotakashi 0:8fdf9a60065b 33 // Initial '/'
kadonotakashi 0:8fdf9a60065b 34 char* p = request;
kadonotakashi 0:8fdf9a60065b 35 if (*p != '/') return;
kadonotakashi 0:8fdf9a60065b 36 p++;
kadonotakashi 0:8fdf9a60065b 37
kadonotakashi 0:8fdf9a60065b 38 // Object Name
kadonotakashi 0:8fdf9a60065b 39 p = search_arg(&obj_name, p, '/');
kadonotakashi 0:8fdf9a60065b 40 if (p == NULL) return;
kadonotakashi 0:8fdf9a60065b 41
kadonotakashi 0:8fdf9a60065b 42 // Method Name
kadonotakashi 0:8fdf9a60065b 43 p = search_arg(&method_name, p, ' ');
kadonotakashi 0:8fdf9a60065b 44 if (p == NULL) return;
kadonotakashi 0:8fdf9a60065b 45
kadonotakashi 0:8fdf9a60065b 46 // Arguments
kadonotakashi 0:8fdf9a60065b 47 while (true) {
kadonotakashi 0:8fdf9a60065b 48 argv[argc] = NULL;
kadonotakashi 0:8fdf9a60065b 49 p = search_arg(&argv[argc], p, ' ');
kadonotakashi 0:8fdf9a60065b 50 if (argv[argc] != NULL) argc++;
kadonotakashi 0:8fdf9a60065b 51 if (p == NULL) break;
kadonotakashi 0:8fdf9a60065b 52 }
kadonotakashi 0:8fdf9a60065b 53
kadonotakashi 0:8fdf9a60065b 54 index = -1;
kadonotakashi 0:8fdf9a60065b 55 }
kadonotakashi 0:8fdf9a60065b 56
kadonotakashi 0:8fdf9a60065b 57 char* Arguments::search_arg(char **arg, char *p, char next_sep) {
kadonotakashi 0:8fdf9a60065b 58 char *s = p;
kadonotakashi 0:8fdf9a60065b 59 while (true) {
kadonotakashi 0:8fdf9a60065b 60 if ((*p == '/') || (*p == ' ') || (*p == '\n') || (*p == '\0')) break;
kadonotakashi 0:8fdf9a60065b 61 p++;
kadonotakashi 0:8fdf9a60065b 62 }
kadonotakashi 0:8fdf9a60065b 63 if (p == s) return NULL;
kadonotakashi 0:8fdf9a60065b 64 *arg = s;
kadonotakashi 0:8fdf9a60065b 65 char separator = *p;
kadonotakashi 0:8fdf9a60065b 66 *p = '\0';
kadonotakashi 0:8fdf9a60065b 67 p++;
kadonotakashi 0:8fdf9a60065b 68 return (separator == next_sep) ? (p) : (NULL);
kadonotakashi 0:8fdf9a60065b 69 }
kadonotakashi 0:8fdf9a60065b 70
kadonotakashi 0:8fdf9a60065b 71 template<> PinName Arguments::getArg<PinName>(void) {
kadonotakashi 0:8fdf9a60065b 72 index++;
kadonotakashi 0:8fdf9a60065b 73 return parse_pins(argv[index]);
kadonotakashi 0:8fdf9a60065b 74 }
kadonotakashi 0:8fdf9a60065b 75
kadonotakashi 0:8fdf9a60065b 76 template<> int Arguments::getArg<int>(void) {
kadonotakashi 0:8fdf9a60065b 77 index++;
kadonotakashi 0:8fdf9a60065b 78 char *pEnd;
kadonotakashi 0:8fdf9a60065b 79 return strtol(argv[index], &pEnd, 10);
kadonotakashi 0:8fdf9a60065b 80 }
kadonotakashi 0:8fdf9a60065b 81
kadonotakashi 0:8fdf9a60065b 82 template<> const char* Arguments::getArg<const char*>(void) {
kadonotakashi 0:8fdf9a60065b 83 index++;
kadonotakashi 0:8fdf9a60065b 84 return argv[index];
kadonotakashi 0:8fdf9a60065b 85 }
kadonotakashi 0:8fdf9a60065b 86
kadonotakashi 0:8fdf9a60065b 87 template<> char Arguments::getArg<char>(void) {
kadonotakashi 0:8fdf9a60065b 88 index++;
kadonotakashi 0:8fdf9a60065b 89 return *argv[index];
kadonotakashi 0:8fdf9a60065b 90 }
kadonotakashi 0:8fdf9a60065b 91
kadonotakashi 0:8fdf9a60065b 92 template<> double Arguments::getArg<double>(void) {
kadonotakashi 0:8fdf9a60065b 93 index++;
kadonotakashi 0:8fdf9a60065b 94 return atof(argv[index]);
kadonotakashi 0:8fdf9a60065b 95 }
kadonotakashi 0:8fdf9a60065b 96
kadonotakashi 0:8fdf9a60065b 97 template<> float Arguments::getArg<float>(void) {
kadonotakashi 0:8fdf9a60065b 98 index++;
kadonotakashi 0:8fdf9a60065b 99 return atof(argv[index]);
kadonotakashi 0:8fdf9a60065b 100 }
kadonotakashi 0:8fdf9a60065b 101
kadonotakashi 0:8fdf9a60065b 102 Reply::Reply(char* r) {
kadonotakashi 0:8fdf9a60065b 103 first = true;
kadonotakashi 0:8fdf9a60065b 104 *r = '\0';
kadonotakashi 0:8fdf9a60065b 105 reply = r;
kadonotakashi 0:8fdf9a60065b 106 }
kadonotakashi 0:8fdf9a60065b 107
kadonotakashi 0:8fdf9a60065b 108 void Reply::separator(void) {
kadonotakashi 0:8fdf9a60065b 109 if (first) {
kadonotakashi 0:8fdf9a60065b 110 first = false;
kadonotakashi 0:8fdf9a60065b 111 } else {
kadonotakashi 0:8fdf9a60065b 112 *reply = ' '; reply++;
kadonotakashi 0:8fdf9a60065b 113 }
kadonotakashi 0:8fdf9a60065b 114 }
kadonotakashi 0:8fdf9a60065b 115
kadonotakashi 0:8fdf9a60065b 116 template<> void Reply::putData<const char*>(const char* s) {
kadonotakashi 0:8fdf9a60065b 117 separator();
kadonotakashi 0:8fdf9a60065b 118 reply += sprintf(reply, "%s", s);
kadonotakashi 0:8fdf9a60065b 119 }
kadonotakashi 0:8fdf9a60065b 120
kadonotakashi 0:8fdf9a60065b 121 template<> void Reply::putData<char*>(char* s) {
kadonotakashi 0:8fdf9a60065b 122 separator();
kadonotakashi 0:8fdf9a60065b 123 reply += sprintf(reply, "%s", s);
kadonotakashi 0:8fdf9a60065b 124 }
kadonotakashi 0:8fdf9a60065b 125
kadonotakashi 0:8fdf9a60065b 126 template<> void Reply::putData<char>(char c) {
kadonotakashi 0:8fdf9a60065b 127 separator();
kadonotakashi 0:8fdf9a60065b 128 reply += sprintf(reply, "%c", c);
kadonotakashi 0:8fdf9a60065b 129 }
kadonotakashi 0:8fdf9a60065b 130
kadonotakashi 0:8fdf9a60065b 131 template<> void Reply::putData<int>(int v) {
kadonotakashi 0:8fdf9a60065b 132 separator();
kadonotakashi 0:8fdf9a60065b 133 reply += sprintf(reply, "%d", v);
kadonotakashi 0:8fdf9a60065b 134 }
kadonotakashi 0:8fdf9a60065b 135
kadonotakashi 0:8fdf9a60065b 136 template<> void Reply::putData<float>(float f) {
kadonotakashi 0:8fdf9a60065b 137 separator();
kadonotakashi 0:8fdf9a60065b 138 reply += sprintf(reply, "%.17g", f);
kadonotakashi 0:8fdf9a60065b 139 }
kadonotakashi 0:8fdf9a60065b 140
kadonotakashi 0:8fdf9a60065b 141 } // namespace mbed