@Override public double[] getMessageValues() { return new double[] { force.getX(), force.getY(), force.getZ(), position.getX(), position.getY(), position.getZ(), groundContactPoint.getYoFootSwitch().getDoubleValue() }; }
@Override public String getYoVariableOrder() { String variableOrder = force.getYoX().getName() + "," + force.getYoY().getName() + "," + force.getYoZ().getName() + "," + position.getYoX().getName() + "," + position.getYoY().getName() + "," + position.getYoZ().getName() + "," + groundContactPoint.getYoFootSwitch().getName(); return variableOrder; }