| [5741] | 1 | #include <sstream>
|
|---|
| 2 | #include <iomanip>
|
|---|
| 3 | #include <stdlib.h>
|
|---|
| 4 |
|
|---|
| 5 | #include "t_prn.h"
|
|---|
| 6 |
|
|---|
| 7 | using namespace BNC;
|
|---|
| 8 | using namespace std;
|
|---|
| 9 |
|
|---|
| 10 | //
|
|---|
| 11 | //////////////////////////////////////////////////////////////////////////////
|
|---|
| 12 | int t_prn::toInt() const {
|
|---|
| 13 | if (_system == 'G') {
|
|---|
| 14 | return _number;
|
|---|
| 15 | }
|
|---|
| 16 | else if (_system == 'R') {
|
|---|
| 17 | return MAXPRN_GPS + _number;
|
|---|
| 18 | }
|
|---|
| 19 | return 0;
|
|---|
| 20 | }
|
|---|
| 21 |
|
|---|
| 22 | //
|
|---|
| 23 | //////////////////////////////////////////////////////////////////////////////
|
|---|
| 24 | string t_prn::toString() const {
|
|---|
| 25 | stringstream ss;
|
|---|
| 26 | ss << _system << setfill('0') << setw(2) << _number;
|
|---|
| 27 | return ss.str();
|
|---|
| 28 | }
|
|---|
| 29 |
|
|---|
| 30 | // Set from string
|
|---|
| 31 | ////////////////////////////////////////////////////////////////////////////
|
|---|
| 32 | void t_prn::setValue(const std::string& str) {
|
|---|
| 33 | unsigned prn = 0;
|
|---|
| 34 | char system = '\x0';
|
|---|
| 35 | const char* number = 0;
|
|---|
| 36 | if ( str[0] == 'G' || str[0] == 'R') {
|
|---|
| 37 | system = str[0];
|
|---|
| 38 | number = str.c_str() + 1;
|
|---|
| 39 | }
|
|---|
| 40 | else if ( isdigit(str[0]) ) {
|
|---|
| 41 | system = 'G';
|
|---|
| 42 | number = str.c_str();
|
|---|
| 43 | }
|
|---|
| 44 | else {
|
|---|
| 45 | throw "t_prn::setValue: wrong satellite ID: " + str;
|
|---|
| 46 | }
|
|---|
| 47 |
|
|---|
| 48 | char* tmpc = 0;
|
|---|
| 49 | prn = strtol(number, &tmpc, 10);
|
|---|
| 50 | if ( tmpc == number || *tmpc != '\x0' ) {
|
|---|
| 51 | throw "t_prn::setValue: wrong satellite ID: " + str;
|
|---|
| 52 | }
|
|---|
| 53 |
|
|---|
| 54 | try {
|
|---|
| 55 | this->setValue(system, prn);
|
|---|
| 56 | }
|
|---|
| 57 | catch (string exc) {
|
|---|
| 58 | throw "t_prn::setValue: wrong satellite ID: " + str;
|
|---|
| 59 | }
|
|---|
| 60 | }
|
|---|
| 61 |
|
|---|
| 62 | void t_prn::setValue(char system, unsigned prn) {
|
|---|
| 63 | _system = system;
|
|---|
| 64 | _number = prn;
|
|---|
| 65 | int maxprn = 0;
|
|---|
| 66 | switch (system) {
|
|---|
| 67 | case 'G':
|
|---|
| 68 | maxprn = MAXPRN_GPS;
|
|---|
| 69 | break;
|
|---|
| 70 | case 'R':
|
|---|
| 71 | maxprn = MAXPRN_GLONASS;
|
|---|
| 72 | break;
|
|---|
| 73 | default:
|
|---|
| 74 | throw "t_prn::setValue: wrong satellite system identifier";
|
|---|
| 75 | break;
|
|---|
| 76 | }
|
|---|
| 77 | if (_number > maxprn) {
|
|---|
| 78 | ostringstream msg;
|
|---|
| 79 | msg << "wrong satellite ID, system ID: " << system << " number: " << prn;
|
|---|
| 80 | throw "t_prn::setValue: " + msg.str();
|
|---|
| 81 | }
|
|---|
| 82 | }
|
|---|
| 83 |
|
|---|
| 84 | //
|
|---|
| 85 | //////////////////////////////////////////////////////////////////////////////
|
|---|
| 86 | t_prn::operator unsigned() const {
|
|---|
| 87 | return toInt();
|
|---|
| 88 | }
|
|---|
| 89 |
|
|---|
| 90 | //
|
|---|
| 91 | //////////////////////////////////////////////////////////////////////////////
|
|---|
| 92 | istream& GPSS::operator >> (istream& in, t_prn& prn) {
|
|---|
| 93 | string str;
|
|---|
| 94 | in >> str;
|
|---|
| 95 | if (str.length() == 1 && !isdigit(str[0])) {
|
|---|
| 96 | string str2;
|
|---|
| 97 | in >> str2;
|
|---|
| 98 | str += str2;
|
|---|
| 99 | }
|
|---|
| 100 | prn.setValue(str);
|
|---|
| 101 | return in;
|
|---|
| 102 | }
|
|---|