![](/media/cache/profiles/2012_sf_avc_095.jpg.50x50_q85.jpg)
Code for autonomous rover for Sparkfun AVC. DataBus won 3rd in 2012 and the same code was used on Troubled Child, a 1986 Jeep Grand Wagoneer to win 1st in 2014.
Dependencies: mbed Watchdog SDFileSystem DigoleSerialDisp
Diff: util.cpp
- Revision:
- 0:a6a169de725f
- Child:
- 2:fbc6e3cf3ed8
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/util.cpp Mon May 27 13:26:03 2013 +0000 @@ -0,0 +1,78 @@ +// convert character to an int +// +int ctoi(char c) +{ + int i=-1; + + if (c >= '0' && c <= '9') { + i = c - '0'; + } + + //printf("char: %c int %d\n", c, i); + + return i; +} + + +// convert string to floating point +// +double cvstof(char *s) +{ + double f=0.0; + double mult = 0.1; + bool neg = false; + //char dec = 1; + + // leading spaces + while (*s == ' ' || *s == '\t') { + s++; + if (*s == 0) break; + } + + // What about negative numbers? + if (*s == '-') { + neg = true; + s++; + } + + // before the decimal + // + while (*s != 0) { + if (*s == '.') { + s++; + break; + } + f = (f * 10.0) + (double) ctoi(*s); + s++; + } + // after the decimal + while (*s != 0 && *s >= '0' && *s <= '9') { + f += (double) ctoi(*s) * mult; + mult /= 10; + s++; + } + + // if we were negative... + if (neg) f = -f; + + return f; +} + +// copy t to s until delimiter is reached +// return location of delimiter+1 in t +// if s or t null, return null +char *split(char *s, char *t, int max, char delim) +{ + int i = 0; + + if (s == 0 || t == 0) + return 0; + + while (*t != 0 && *t != '\n' && *t != delim && i < max) { + *s++ = *t++; + i++; + } + *s = 0; + + return t+1; +}