本页介绍了get_sensor_value的用法, 包含当前所有传感器的类型，安装位置，触发状态等。
（以下任选其一）
代码功能说明： 获取传感器数据
SlamwareCorePlatform sdp = SlamwareCorePlatform::connect(argv[1], 1445);
std::cout <<"SDK Version: " << sdp.getSDKVersion() << std::endl;
std::cout <<"SDP Version: " << sdp.getSDPVersion() << std::endl;
std::vector<ImpactSensorInfo> sensors;
bool result = sdp.getSensors(sensors);
if (result) {
for (std::vector<ImpactSensorInfo>::iterator it = sensors.begin(); it != sensors.end(); ++it) {
std::cout << "Sensor id : " << it->id << std::endl;
if (it->kind == ImpactSensorKindBumper)
std::cout << "Sensor Kind: Bumper" << std::endl;
else if (it->kind == ImpactSensorKindCliff)
std::cout << "Sensor Kind: Cliff" << std::endl;
else if (it->kind == ImpactSensorKindSonar)
std::cout << "Sensor Kind: Sonar" << std::endl;
else
return 1;
if (it->type == ImpactSensorTypeAnalog)
std::cout << "Sensor Type: Analog" << std::endl;
else if (it->type == ImpactSensorTypeDigital)
std::cout << "Sensor Type: Digital" << std::endl;
else
return 1;
std::cout << "Sensor Position: ( " << it->pose.x() << " , " << it->pose.y() << " , " << \
it->pose.z() << " ) ; Yaw = " << it->pose.yaw() << std::endl;
ImpactSensorValue value;
sdp.getSensorValue(it->id, value);
std::cout << "Sensor Value : " << value.value<< std::endl;
}
}
|