idfetchhelpers.h
Go to the documentation of this file.
1 
2 // Copyright (c) 2003-2021 Xsens Technologies B.V. or subsidiaries worldwide.
3 // All rights reserved.
4 //
5 // Redistribution and use in source and binary forms, with or without modification,
6 // are permitted provided that the following conditions are met:
7 //
8 // 1. Redistributions of source code must retain the above copyright notice,
9 // this list of conditions, and the following disclaimer.
10 //
11 // 2. Redistributions in binary form must reproduce the above copyright notice,
12 // this list of conditions, and the following disclaimer in the documentation
13 // and/or other materials provided with the distribution.
14 //
15 // 3. Neither the names of the copyright holders nor the names of their contributors
16 // may be used to endorse or promote products derived from this software without
17 // specific prior written permission.
18 //
19 // THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY
20 // EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
21 // MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
22 // THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
23 // SPECIAL, EXEMPLARY OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT
24 // OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25 // HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY OR
26 // TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
27 // SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.THE LAWS OF THE NETHERLANDS
28 // SHALL BE EXCLUSIVELY APPLICABLE AND ANY DISPUTES SHALL BE FINALLY SETTLED UNDER THE RULES
29 // OF ARBITRATION OF THE INTERNATIONAL CHAMBER OF COMMERCE IN THE HAGUE BY ONE OR MORE
30 // ARBITRATORS APPOINTED IN ACCORDANCE WITH SAID RULES.
31 //
32 
33 
34 // Copyright (c) 2003-2021 Xsens Technologies B.V. or subsidiaries worldwide.
35 // All rights reserved.
36 //
37 // Redistribution and use in source and binary forms, with or without modification,
38 // are permitted provided that the following conditions are met:
39 //
40 // 1. Redistributions of source code must retain the above copyright notice,
41 // this list of conditions, and the following disclaimer.
42 //
43 // 2. Redistributions in binary form must reproduce the above copyright notice,
44 // this list of conditions, and the following disclaimer in the documentation
45 // and/or other materials provided with the distribution.
46 //
47 // 3. Neither the names of the copyright holders nor the names of their contributors
48 // may be used to endorse or promote products derived from this software without
49 // specific prior written permission.
50 //
51 // THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY
52 // EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
53 // MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
54 // THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
55 // SPECIAL, EXEMPLARY OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT
56 // OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
57 // HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY OR
58 // TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
59 // SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.THE LAWS OF THE NETHERLANDS
60 // SHALL BE EXCLUSIVELY APPLICABLE AND ANY DISPUTES SHALL BE FINALLY SETTLED UNDER THE RULES
61 // OF ARBITRATION OF THE INTERNATIONAL CHAMBER OF COMMERCE IN THE HAGUE BY ONE OR MORE
62 // ARBITRATORS APPOINTED IN ACCORDANCE WITH SAID RULES.
63 //
64 
65 #ifndef IDFETCHHELPERS_H
66 #define IDFETCHHELPERS_H
67 
68 #include <regex>
69 #include <xstypes/xsdeviceid.h>
70 #include <algorithm>
71 
72 /* Helper functions for fetching of device/vendor/product ids from text strings */
73 
74 /* Get the first match for _regex_ within _string_ */
75 static inline std::string searchOne(std::string const& string, std::string const& regex)
76 {
77  std::smatch sm;
78  std::regex_search(string, sm, std::regex(regex));
79  if (sm.size() < 2)
80  return std::string();
81  return sm[1];
82 }
83 
84 /* Fetch the device ID from the given device path */
85 static inline XsDeviceId deviceIdFromDevPath(std::string const& devpath)
86 {
87  XsDeviceId deviceId;
88  std::string id = searchOne(devpath, "([0-9A-Fa-f]*)$");
89  if (!id.empty())
90  deviceId.fromString(XsString(id));
91  return deviceId;
92 }
93 
94 /* Fetch the vendor ID from the given string */
95 static inline uint16_t vidFromString(std::string const& string)
96 {
97  try
98  {
99  std::string regex = string;
100  std::transform(regex.begin(), regex.end(), regex.begin(), ::toupper);
101  auto t1 = searchOne(regex, "VID_([0-9a-fA-F]{4}).*PID_.*");
102  if (t1.empty()) // prevent unnecessary exceptions
103  return 0;
104  return static_cast<uint16_t>(std::stoi(t1, nullptr, 16));
105  }
106  catch (std::invalid_argument&)
107  {
108  return 0;
109  }
110 }
111 
112 /* Fetch the product ID from the given string */
113 static inline uint16_t pidFromString(std::string const& string)
114 {
115  try
116  {
117  std::string regex = string;
118  std::transform(regex.begin(), regex.end(), regex.begin(), ::toupper);
119  auto t1 = searchOne(regex, "VID_.*PID_([0-9a-fA-F]{4})");
120  if (t1.empty()) // prevent unnecessary exceptions
121  return 0;
122  return static_cast<uint16_t>(std::stoi(t1, nullptr, 16));
123  }
124  catch (std::invalid_argument&)
125  {
126  return 0;
127  }
128 }
129 
130 #endif
XsString
struct XsString XsString
Definition: xsstring.h:87
searchOne
static std::string searchOne(std::string const &string, std::string const &regex)
Definition: idfetchhelpers.h:75
deviceIdFromDevPath
static XsDeviceId deviceIdFromDevPath(std::string const &devpath)
Definition: idfetchhelpers.h:85
xsdeviceid.h
XsDeviceId
Contains an Xsens device ID and provides operations for determining the type of device.
Definition: xsdeviceid.h:192
vidFromString
static uint16_t vidFromString(std::string const &string)
Definition: idfetchhelpers.h:95
pidFromString
static uint16_t pidFromString(std::string const &string)
Definition: idfetchhelpers.h:113


xsens_mti_driver
Author(s):
autogenerated on Sun Sep 3 2023 02:43:20