private void checkBox_EnableJoystick_CheckedChanged(object sender, EventArgs e)
{
var isChecked = ((CheckBox)sender).Checked;
Properties.Settings.Default.EnableJoystick = isChecked;
Properties.Settings.Default.Save();
bool status;
if (checkBox_EnableJoystick.Checked)
{
VJoyFeeder.Initialize((uint)VJoyIDUpDown.Value);
status = true;
}
else
{
status = false;
}
checkBox_SendCGtoXY.Enabled = status;
checkBox_Send4LoadSensors.Enabled = status;
}
private void InfoUpdate()
{
if (wiiDevice.WiimoteState.ExtensionType != ExtensionType.BalanceBoard)
{
label_Status.Text = "DEVICE IS NOT A BALANCE BOARD...";
return;
}
// Get the current sensor KG values. (no temperature / latitude correction, can't set zero point properly.)
var rwWeight = wiiDevice.WiimoteState.BalanceBoardState.WeightKg;
var rwTopLeft = wiiDevice.WiimoteState.BalanceBoardState.SensorValuesKg.TopLeft;
var rwTopRight = wiiDevice.WiimoteState.BalanceBoardState.SensorValuesKg.TopRight;
var rwBottomLeft = wiiDevice.WiimoteState.BalanceBoardState.SensorValuesKg.BottomLeft;
var rwBottomRight = wiiDevice.WiimoteState.BalanceBoardState.SensorValuesKg.BottomRight;
var aButton = wiiDevice.WiimoteState.ButtonState.A;
// The alternative .SensorValuesRaw is meaningless in terms of actual weight. not adjusted with 0KG, 17KG and 34KG calibration data.
//var rwTopLeft = wiiDevice.WiimoteState.BalanceBoardState.SensorValuesRaw.TopLeft - wiiDevice.WiimoteState.BalanceBoardState.CalibrationInfo.Kg0.TopLeft;
//var rwTopRight = wiiDevice.WiimoteState.BalanceBoardState.SensorValuesRaw.TopRight - wiiDevice.WiimoteState.BalanceBoardState.CalibrationInfo.Kg0.TopRight;
//var rwBottomLeft = wiiDevice.WiimoteState.BalanceBoardState.SensorValuesRaw.BottomLeft - wiiDevice.WiimoteState.BalanceBoardState.CalibrationInfo.Kg0.BottomLeft;
//var rwBottomRight = wiiDevice.WiimoteState.BalanceBoardState.SensorValuesRaw.BottomRight - wiiDevice.WiimoteState.BalanceBoardState.CalibrationInfo.Kg0.BottomRight;
// Show the sensor values in kg.
label_rwWT.Text = rwWeight.ToString("0.0");
label_rwTL.Text = rwTopLeft.ToString("0.0");
label_rwTR.Text = rwTopRight.ToString("0.0");
label_rwBL.Text = rwBottomLeft.ToString("0.0");
label_rwBR.Text = rwBottomRight.ToString("0.0");
// Prevent negative values by tracking lowest possible value and making it a zero based offset.
if (rwWeight > 5)
{
button_SetCenterOffset.Enabled = true;
button_SetCenterOffset.Text = "Set current balance as center";
//toolTip1.SetToolTip(button_SetCenterOffset, "While standing or sitting on the balance board, click this button to set your current balance point as center");
}
else
{
if (resetCenterOffsetPossible)
{
button_SetCenterOffset.Enabled = true;
button_SetCenterOffset.Text = "Reset Center Offset";
//toolTip1.SetToolTip(button_SetCenterOffset, "Revert back to the original center balance point, for the X/Y controlsl");
}
else
{
button_SetCenterOffset.Text = "Set current balance as center";
button_SetCenterOffset.Enabled = false;
}
}
if (rwTopLeft < naCorners)
{
naCorners = rwTopLeft;
}
if (rwTopRight < naCorners)
{
naCorners = rwTopRight;
}
if (rwBottomLeft < naCorners)
{
naCorners = rwBottomLeft;
}
if (rwBottomRight < naCorners)
{
naCorners = rwBottomRight;
}
// Negative total weight is reset to zero as jumping or lifting the board causes negative spikes, which would break 'in use' checks.
var owWeight = rwWeight < 0f ? 0f : rwWeight;
var owTopLeft = rwTopLeft -= naCorners;
var owTopRight = rwTopRight -= naCorners;
var owBottomLeft = rwBottomLeft -= naCorners;
var owBottomRight = rwBottomRight -= naCorners;
// Get offset that would make current values the center of mass.
if (setCenterOffset)
{
setCenterOffset = false;
resetCenterOffsetPossible = true;
var rwHighest = Math.Max(Math.Max(rwTopLeft, rwTopRight), Math.Max(rwBottomLeft, rwBottomRight));
oaTopLeft = rwHighest - rwTopLeft;
oaTopRight = rwHighest - rwTopRight;
oaBottomLeft = rwHighest - rwBottomLeft;
oaBottomRight = rwHighest - rwBottomRight;
}
// Keep values only when board is being used, otherwise offsets and small value jitters can trigger unwanted actions.
if (owWeight > 5f) // minimal weight of 5kg
{
owTopLeft += oaTopLeft;
owTopRight += oaTopRight;
owBottomLeft += oaBottomLeft;
owBottomRight += oaBottomRight;
}
else
{
owTopLeft = 0;
owTopRight = 0;
owBottomLeft = 0;
owBottomRight = 0;
}
label_owWT.Text = owWeight.ToString("0.0");
label_owTL.Text = owTopLeft.ToString("0.0") + "\r\n" + oaTopLeft.ToString("0.0");
label_owTR.Text = owTopRight.ToString("0.0") + "\r\n" + oaTopRight.ToString("0.0");
label_owBL.Text = owBottomLeft.ToString("0.0") + "\r\n" + oaBottomLeft.ToString("0.0");
label_owBR.Text = owBottomRight.ToString("0.0") + "\r\n" + oaBottomRight.ToString("0.0");
// Calculate each weight ratio.
var owrPercentage = 100 / (owTopLeft + owTopRight + owBottomLeft + owBottomRight);
var owrTopLeft = owrPercentage * owTopLeft;
var owrTopRight = owrPercentage * owTopRight;
var owrBottomLeft = owrPercentage * owBottomLeft;
var owrBottomRight = owrPercentage * owBottomRight;
label_owrTL.Text = owrTopLeft.ToString("0.0");
label_owrTR.Text = owrTopRight.ToString("0.0");
label_owrBL.Text = owrBottomLeft.ToString("0.0");
label_owrBR.Text = owrBottomRight.ToString("0.0");
// Calculate balance ratio.
var brX = owrBottomRight + owrTopRight;
var brY = owrBottomRight + owrBottomLeft;
label_brX.Text = brX.ToString("0.0");
label_brY.Text = brY.ToString("0.0");
// Diagonal ratio used for turning on the spot.
var brDL = owrPercentage * (owBottomLeft + owTopRight);
var brDR = owrPercentage * (owBottomRight + owTopLeft);
var brDF = Math.Abs(brDL - brDR);
label_brDL.Text = brDL.ToString("0.0");
label_brDR.Text = brDR.ToString("0.0");
label_brDF.Text = brDF.ToString("0.0");
// Convert sensor values into actions.
var sendLeft = false;
var sendRight = false;
var sendForward = false;
var sendBackward = false;
var sendModifier = false;
var sendJump = false;
var sendDiagonalLeft = false;
var sendDiagonalRight = false;
if (brX < (float)(50 - numericUpDown_TLR.Value))
{
sendLeft = true;
}
if (brX > (float)(50 + numericUpDown_TLR.Value))
{
sendRight = true;
}
if (brY < (float)(50 - numericUpDown_TFB.Value))
{
sendForward = true;
}
if (brY > (float)(50 + numericUpDown_TFB.Value))
{
sendBackward = true;
}
if (brX < (float)(50 - numericUpDown_TMLR.Value))
{
sendModifier = true;
}
else if (brX > (float)(50 + numericUpDown_TMLR.Value))
{
sendModifier = true;
}
else if (brY < (float)(50 - numericUpDown_TMFB.Value))
{
sendModifier = true;
}
else if (brY > (float)(50 + numericUpDown_TMFB.Value))
{
sendModifier = true;
}
// Detect jump but use a time limit to stop it being active while off the board.
if (owWeight < 1f)
{
if (DateTime.UtcNow.Subtract(jumpTime).Seconds < 2)
{
sendJump = true;
}
}
else
{
jumpTime = DateTime.UtcNow;
}
// Check for diagonal pressure only when no other movement actions are active.
if (!sendLeft && !sendRight && !sendForward && !sendBackward && brDF > 15)
{
if (brDL > brDR)
{
sendDiagonalLeft = true;
}
else
{
sendDiagonalRight = true;
}
}
// Display actions.
label_Status.Text = "Result: ";
if (sendForward)
{
label_Status.Text += "Forward";
}
if (sendLeft)
{
label_Status.Text += "Left";
}
if (sendBackward)
{
label_Status.Text += "Backward";
}
if (sendRight)
{
label_Status.Text += "Right";
}
if (sendModifier)
{
label_Status.Text += " + Modifier";
}
if (sendJump)
{
label_Status.Text += "Jump";
}
if (sendDiagonalLeft)
{
label_Status.Text += "Diagonal Left";
}
if (sendDiagonalRight)
{
label_Status.Text += "Diagonal Right";
}
if (checkBox_DisableActions.Checked)
{
label_Status.Text += " ( DISABLED )";
}
// Send actions.
if (!checkBox_DisableActions.Checked)
{
if (sendLeft)
{
actionList.Left.Start();
}
else
{
actionList.Left.Stop();
}
if (sendRight)
{
actionList.Right.Start();
}
else
{
actionList.Right.Stop();
}
if (sendForward)
{
actionList.Forward.Start();
}
else
{
actionList.Forward.Stop();
}
if (sendBackward)
{
actionList.Backward.Start();
}
else
{
actionList.Backward.Stop();
}
if (sendModifier)
{
actionList.Modifier.Start();
}
else
{
actionList.Modifier.Stop();
}
if (sendJump)
{
actionList.Jump.Start();
}
else
{
actionList.Jump.Stop();
}
if (sendDiagonalLeft)
{
actionList.DiagonalLeft.Start();
}
else
{
actionList.DiagonalLeft.Stop();
}
if (sendDiagonalRight)
{
actionList.DiagonalRight.Start();
}
else
{
actionList.DiagonalRight.Stop();
}
}
// Update joystick emulator.
if (checkBox_EnableJoystick.Checked)
{
double joyX = 0, joyY = 0;
// send X/Y position of the player's Center of Gravity through vJoy
if (checkBox_SendCGtoXY.Checked)
{
//var cgF = wiiDevice.WiimoteState.BalanceBoardState.CenterOfGravity; // this is a nice function, but since I found out that wiimote library won't let me: 1.tare the balance board 2.compensate for temperature / latitude 3.has a bug with the kg values (each sensor is 4 times too big, but the overall weight is fine) then I'm not using it. It cannot give calibrated results.
// Uses Int16 ( -32767 to +32767 ) where 0 is the center. Multiplied by 2 because realistic usage is between the 30-70% ratio.
joyX = (brX * 655.34 + -32767.0) * 2.0;
joyY = (brY * 655.34 + -32767.0) * 2.0;
//Console.WriteLine("joyX {0} JoyY {1}",joyX, joyY);
// Limit values to Int16, you cannot just (cast) or Convert.ToIn16() as the value '+ - sign' may invert.
if (joyX < short.MinValue)
{
joyX = short.MinValue;
}
if (joyY < short.MinValue)
{
joyY = short.MinValue;
}
if (joyX > short.MaxValue)
{
joyX = short.MaxValue;
}
if (joyY > short.MaxValue)
{
joyY = short.MaxValue;
}
if (Double.IsNaN(joyX))
{
joyX = 0.0; // send the dead center value if not enough weight is on the board
}
if (Double.IsNaN(joyY))
{
joyY = 0.0;
}
}
if (!checkBox_Send4LoadSensors.Checked)
{
rwTopLeft = 0; rwTopRight = 0; rwBottomLeft = 0; rwBottomRight = 0;
}
string values = string.Format("X:{0,6:#####} Y:{1,6:#####} Z:{2,6:###.##} XR:{3,6:###.##} YR:{4,6:###.##} ZR:{5,6:###.##}", joyX, joyY, rwTopLeft, rwTopRight, rwBottomLeft, rwBottomRight);
if (checkBox_ShowValuesInConsole.Checked)
{
BalanceWalker.FormMain.consoleBoxWriteLine(values);
}
VJoyFeeder.Setjoystick((int)joyX, (int)joyY, (int)(rwTopLeft * 100), (int)(rwTopRight * 100), (int)(rwBottomLeft * 100), (int)(rwBottomRight * 100), aButton);
}
}
