/// <summary>
/// Adds the given label to the <see cref="PositionQueues"/> dictionary if it is not present.
/// </summary>
/// <param name="label">The label to be added.</param>
protected virtual void UpdatePositionDictionaries(string label)
{
lock (PositionLocks)
{
if (ContainsPosition(label))
{
return;
}
PositionLocks.Add(label, new object());
PositionQueues.Add(label, new Queue <UdpPosition>());
}
}
/// <summary>
/// Returns the Vector3 representing the position of the given label. Can be redefined in children classes to change the smoothing logic. Current smoothing logic is as follows:<para><example> <see cref="GenericDeviceController.Smoothing"/> ? <see cref="Smoother.Average(System.Collections.Generic.Queue{Neurorehab.Scripts.Devices.UdpPosition})"/> : queue.LastOrDefault()</example></para>
/// </summary>
/// <param name="label">The label to get the rotation.</param>
/// <returns>A Vector3 representing the rotation of the given label.</returns>
public virtual Vector3 GetPosition(string label)
{
if (PositionLocks.ContainsKey(label) == false)
{
return(Vector3.zero);
}
var @lock = PositionLocks[label];
var queue = PositionQueues[label];
lock (@lock)
{
return((Controller.Smoothing ?
Smoother.Average(queue) : queue.Count == 0 ?
Vector3.zero : queue.Last().Position) * Controller.PositionMultiplier);
}
}
/// <summary>
/// Returns the Vector3 representing the position of the given label according to the <see cref="GenericDeviceController.Smoothing"/> and <see cref="GenericDeviceController.PositionMultiplier"/>.
/// </summary>
/// <param name="label">The label to get the rotation.</param>
/// <returns>A Vector3 representing the rotation of the given label where the x and z are multiplied by the <see cref="GenericDeviceController.PositionMultiplier"/>.</returns>
public override Vector3 GetPosition(string label)
{
if (PositionLocks.ContainsKey(label) == false)
{
return(Vector3.zero);
}
var @lock = PositionLocks[label];
var queue = PositionQueues[label];
Vector3 position;
lock (@lock)
{
position = Controller.Smoothing ?
Smoother.Average(queue) : queue.Count == 0 ?
Vector3.zero : queue.Last().Position;
}
return(new Vector3(position.x * Controller.PositionMultiplier, position.y,
position.z * Controller.PositionMultiplier));
}
/// <summary>
/// Removes all data from the dictionaries that are older than <see cref="GenericDeviceController.TimeToLive"/>
/// </summary>
private void CleanDictionaries()
{
//sleeps in the beggining to give time for the software to stabilize
//Thread.Sleep(2000);
while (true)
{
//Debug.Log("Cleaning Dictionary");
var keysToKill = new List <string>();
//Debug.Log("TimeToLive" + Controller.TimeToLive);
#region floats
foreach (var floatQueueEntry in FloatQueues)
{
if (floatQueueEntry.Key.Contains("max_"))
{
continue;
}
lock (FloatLocks[floatQueueEntry.Key])
{
while (floatQueueEntry.Value.Count != 0 && (DateTime.Now - floatQueueEntry.Value.Peek().LastTimeUpdated).TotalSeconds >= Controller.TimeToLive)
{
floatQueueEntry.Value.Dequeue();
}
if (floatQueueEntry.Value.Count == 0)
{
keysToKill.Add(floatQueueEntry.Key);
}
}
}
foreach (var key in keysToKill)
{
FloatQueues.Remove(key);
FloatLocks.Remove(key);
}
//Debug.Log("Float count: " + FloatQueues.Count);
#endregion floats
keysToKill.Clear();
#region positions
foreach (var positionQueueEntry in PositionQueues)
{
lock (PositionLocks[positionQueueEntry.Key])
{
while (positionQueueEntry.Value.Count != 0 && (DateTime.Now - positionQueueEntry.Value.Peek().LastTimeUpdated).TotalSeconds >= Controller.TimeToLive)
{
positionQueueEntry.Value.Dequeue();
}
if (positionQueueEntry.Value.Count == 0)
{
keysToKill.Add(positionQueueEntry.Key);
}
}
}
foreach (var key in keysToKill)
{
PositionQueues.Remove(key);
PositionLocks.Remove(key);
}
//Debug.Log("Position count: " + PositionQueues.Count);
#endregion positions
keysToKill.Clear();
#region rotations
foreach (var rotationsQueueEntry in RotationQueues)
{
lock (RotationLocks[rotationsQueueEntry.Key])
{
while (rotationsQueueEntry.Value.Count != 0 && (DateTime.Now - rotationsQueueEntry.Value.Peek().LastTimeUpdated).TotalSeconds >= Controller.TimeToLive)
{
rotationsQueueEntry.Value.Dequeue();
}
if (rotationsQueueEntry.Value.Count == 0)
{
keysToKill.Add(rotationsQueueEntry.Key);
}
}
}
foreach (var key in keysToKill)
{
RotationQueues.Remove(key);
RotationLocks.Remove(key);
}
//Debug.Log("Rotation count: " + RotationQueues.Count);
#endregion rotations
keysToKill.Clear();
#region samples
foreach (var sampleQueueEntry in SampleList)
{
lock (SampleLocks[sampleQueueEntry.Key])
{
if ((DateTime.Now - sampleQueueEntry.Value.LastTimeUpdated).TotalSeconds >= Controller.TimeToLive)
{
keysToKill.Add(sampleQueueEntry.Key);
}
}
}
foreach (var key in keysToKill)
{
SampleList.Remove(key);
SampleLocks.Remove(key);
}
//Debug.Log("Samples count: " + SampleList.Count);
#endregion samples
keysToKill.Clear();
#region booleans
foreach (var booleanQueueEntry in BooleanProperties)
{
lock (BooleanLocks[booleanQueueEntry.Key])
{
if ((DateTime.Now - booleanQueueEntry.Value.LastTimeUpdated).TotalSeconds >= Controller.TimeToLive)
{
keysToKill.Add(booleanQueueEntry.Key);
}
}
}
foreach (var key in keysToKill)
{
BooleanProperties.Remove(key);
BooleanLocks.Remove(key);
}
//Debug.Log("Boolean count: " + BooleanProperties.Count);
#endregion booleans
//Debug.Log("cleaning dictionaries");
Thread.Sleep(50);
}
}
