mcy
/
owlps
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

[Positioning] InputUDPSocket: read calibration data

This commit is contained in:
Matteo Cypriani 2011-03-31 15:59:42 +02:00
parent ebd68a398f
commit 5972e245cc
1 changed files with 18 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

18
owlps-positioning/src/inputudpsocket.cc
View File

@ -140,5 +140,23 @@ const Request& InputUDPSocket::get_next_request()
current_request->set_measurements(measurements) ;
// Calibration request?
if (request.type == OWL_REQUEST_CALIBRATION ||
request.type == OWL_REQUEST_AUTOCALIBRATION)
{
current_request_to_calibration_request() ;
CalibrationRequest *calib_request =
static_cast<CalibrationRequest*>(current_request) ;
calib_request->set_direction(Direction(request.direction)) ;
ReferencePoint position(request.x_position,
request.y_position,
request.z_position) ;
const ReferencePoint &reference_point =
Stock::find_create_reference_point(position) ;
calib_request->set_reference_point(&reference_point) ;
}
return *current_request ;
}