/**
* Set up the data object with empty UltrasoundPoint%s representing the points
* that need to be scanned.
*
* This is analagous to setting up the view frustum in traditional 3D graphics.
*/
private void EstablishScanningPlane(ref UltrasoundScanData data)
{
OnionLogger.globalLog.PushInfoLayer("Pre-populating data");
UltrasoundProbeConfiguration config = data.GetProbeConfig();
// nearZ and farZ represent near and far clipping "planes" (they're really arcs)
float nearZ = config.GetMinScanDistance();
float farZ = config.GetMaxScanDistance();
float arcSizeDegrees = config.GetArcSizeInDegrees();
int scanlines = config.GetNumberOfScanlines();
int pointsPerScanline = config.GetPointsPerScanline();
for (int i = 0; i < scanlines; ++i)
{
UltrasoundScanline scanline = new UltrasoundScanline(config.GetPosition());
float angleInDegrees = -(arcSizeDegrees / 2) + i * arcSizeDegrees / (scanlines - 1);
float angleInRadians = Mathf.Deg2Rad * angleInDegrees;
Vector2 trajectory = new Vector2(Mathf.Sin(angleInRadians), Mathf.Cos(angleInRadians));
for (int j = 0; j < pointsPerScanline; ++j)
{
float d = nearZ + j * (farZ - nearZ) / (pointsPerScanline - 1);
Vector2 positionOnPlane = d * trajectory;
Vector3 positionInWorldSpace = WorldSpaceFromProjectedPosition(positionOnPlane, config);
UltrasoundPoint point = new UltrasoundPoint(positionInWorldSpace, positionOnPlane);
scanline.AddUltrasoundPoint(point);
}
data.AddScanline(scanline);
}
OnionLogger.globalLog.PopInfoLayer();
}
/**
* Helper method to calculate a Vector3 (WorldSpace) from a Projected Position in local space.
* @param positionInPlane A Vector2 representing a point in the scanning plane.
* @param config The UltrasoundProbeConfiguration object, used for rotation and translation.
* @return A 3D point in world space.
*/
private Vector3 WorldSpaceFromProjectedPosition(Vector2 positionInPlane,
UltrasoundProbeConfiguration config)
{
Vector3 positionInWorldSpace = new Vector3(positionInPlane.x, 0, positionInPlane.y);
// Apply rotation, using Quaternion's overloaded * operator.
positionInWorldSpace = config.GetRotation() * positionInWorldSpace;
positionInWorldSpace += config.GetPosition();
return(positionInWorldSpace);
}
/**
* Copy constructor to instantiate a new UltrasoundProbeConfiguration from another.
*
* @param config The other UltrasoundProbeConfiguration object.
* @throw ArgumentNullException
*/
public UltrasoundProbeConfiguration(UltrasoundProbeConfiguration config)
{
UltrasoundDebug.Assert(null != config,
"Null UltrasoundProbeConfiguration used for copy constructor.",
this);
this.SetPosition(config.GetPosition());
this.SetRotation(config.GetRotation());
this.maxDistance = config.GetMaxScanDistance();
this.minDistance = config.GetMinScanDistance();
this.arcSizeInDegrees = config.GetArcSizeInDegrees();
this.pointsPerScanline = config.GetPointsPerScanline();
this.numberOfScanlines = config.GetNumberOfScanlines();
this.gain = config.GetGain();
}
public UltrasoundScanData SendScanData()
{
UltrasoundProbeConfiguration config = new UltrasoundProbeConfiguration();
config.SetMaxScanDistance(MAX_Y);
config.SetMinScanDistance(MIN_Y);
UltrasoundScanData data = new UltrasoundScanData(config);
for (float i = MIN_X; i <= MAX_X; i += STEPSIZE)
{
UltrasoundScanline scanline = new UltrasoundScanline(config.GetPosition());
for (float j = MIN_Y; j <= MAX_Y; j += STEPSIZE)
{
UltrasoundPoint p = new UltrasoundPoint(Vector3.zero, new Vector2(i * (j / MAX_Y), j));
p.SetBrightness(Random.Range(0f, 1f)); // Generate noise.
scanline.AddUltrasoundPoint(p);
}
data.AddScanline(scanline);
}
return(data);
}
