3D coordinates are currently calculated assuming that the depth information given in the distance image is the distance between the object point and the corresponding pixel on the chip.
According to PMD informations, however, this depth information represents the distance between the object point and the pinhole of the camera system (origin of ToF world coordinate system).
The according method in ToFProcessingCommon has to be adapted.