private void SendOscData(SensorEmitterReading values)
{
if (oscEnabled)
{
var sender = new SharpOSC.UDPSender(OSCIP.Text, decimal.ToInt32(OSCIPPort.Value));
if (magnetchk.Checked)
{
if (values.MagnetometerDataValid)
{
var message = new SharpOSC.OscMessage("/magnet/", (float)values.MagnetometerX, (float)values.MagnetometerY, (float)values.MagnetometerZ, (float)values.MagneticHeading);
sender.Send(message);
}
}
if (gravitychk.Checked)
{
var message = new SharpOSC.OscMessage("/gravity/", (float)values.GravityX, (float)values.GravityY, (float)values.GravityZ);
sender.Send(message);
}
if (quaternionchk.Checked)
{
var message = new SharpOSC.OscMessage("/quaternin/", (float)values.QuaternionX, (float)values.QuaternionY, (float)values.QuaternionZ,(float)values.QuaternionW);
sender.Send(message);
}
if (acclerationchk.Checked)
{
var message = new SharpOSC.OscMessage("/accleration/", (float)values.LinearAccelerationX, (float)values.LinearAccelerationY, (float)values.LinearAccelerationZ);
sender.Send(message);
}
if (rotationchk.Checked)
{
var message = new SharpOSC.OscMessage("/rotation/", (float)values.RotationRateX, (float)values.RotationRateY, (float)values.RotationRateZ, (float)values.RotationRoll, (float)values.RotationYaw, (float)values.RotationPitch);
sender.Send(message);
}
}
}
private SensorEmitterReading RoundData(SensorEmitterReading values)
{
values.LinearAccelerationX = Math.Round(values.LinearAccelerationX, 3);
values.LinearAccelerationY = Math.Round(values.LinearAccelerationY, 3);
values.LinearAccelerationZ = Math.Round(values.LinearAccelerationZ, 3);
values.MagnetometerX = Math.Round(values.MagnetometerX, 3);
values.MagnetometerY = Math.Round(values.MagnetometerY, 3);
values.MagnetometerZ = Math.Round(values.MagnetometerZ, 3);
values.MagneticHeading = Math.Round(values.MagneticHeading, 3);
values.GravityX= Math.Round(values.GravityX, 3);
values.GravityY= Math.Round(values.GravityY, 3);
values.GravityZ= Math.Round(values.GravityZ, 3);
values.QuaternionX= Math.Round(values.QuaternionX, 3);
values.QuaternionY= Math.Round(values.QuaternionY, 3);
values.QuaternionZ= Math.Round(values.QuaternionZ, 3);
values.QuaternionW= Math.Round(values.QuaternionW, 3);
values.RotationRateX= Math.Round(values.RotationRateX, 3);
values.RotationRateY= Math.Round(values.RotationRateY, 3);
values.RotationRateZ= Math.Round(values.RotationRateZ, 3);
values.RotationPitch= Math.Round(values.RotationPitch, 3);
values.RotationRoll= Math.Round(values.RotationRoll, 3);
values.RotationYaw= Math.Round(values.RotationYaw, 3);
return values;
}
private void ShowTCPData(SensorEmitterReading values)
{
if (values.MagnetometerDataValid)
{
MagnetX.Text = values.MagnetometerX.ToString();
MagnetY.Text = values.MagnetometerY.ToString();
MagnetZ.Text = values.MagnetometerZ.ToString();
MagnetHeading.Text = values.MagneticHeading.ToString();
}
GarvityX.Text = values.GravityX.ToString();
GarvityY.Text = values.GravityY.ToString();
GarvityZ.Text = values.GravityZ.ToString();
QuatnernionX.Text = values.QuaternionX.ToString();
QuatnernionY.Text = values.QuaternionY.ToString();
QuatnernionZ.Text = values.QuaternionZ.ToString();
QuatnernionW.Text = values.QuaternionW.ToString();
AcclerationX.Text = values.LinearAccelerationX.ToString();
AcclerationY.Text = values.LinearAccelerationY.ToString();
AcclerationZ.Text = values.LinearAccelerationZ.ToString();
RotationX.Text = values.RotationRateX.ToString();
RotationY.Text = values.RotationRateY.ToString();
RotationZ.Text = values.RotationRateZ.ToString();
RotationRoll.Text = values.RotationRoll.ToString();
RotationPitch.Text = values.RotationPitch.ToString();
RotationYaw.Text = values.RotationYaw.ToString();
}