private void fire(int cam)
{
ROS.Info("Trying to set params for cam: " + cam);
cm msg = new cm {
brightness = SUBS[cam][0].Value, contrast = SUBS[cam][1].Value, exposure = SUBS[cam][2].Value, gain = SUBS[cam][3].Value, saturation = SUBS[cam][4].Value, wbt = SUBS[cam][5].Value, exposure_auto = exp, focus_auto = foc
};
pub[cam].publish(msg);
}
public void callback(cm msg)
{
int mydata = Gimme[index](msg);
if (!inited)
{
slider_default = mydata;
inited = true;
}
Value = mydata;
}
private void cb(int c, cm msg)
{
Dispatcher.Invoke(new Action(() =>
{
for (int i = 0; i < SUBS[c].Length; i++)
{
if (SUBS[c][i] != null)
{
SUBS[c][i].callback(msg);
}
else
{
initials[c][i] = msg;
}
}
}));
}
private static int g5(cm c)
{
return(c.wbt);
}
private static int g4(cm c)
{
return(c.saturation);
}
private static int g3(cm c)
{
return(c.gain);
}
private static int g2(cm c)
{
return(c.exposure);
}
private static int g1(cm c)
{
return(c.contrast);
}
private static int g0(cm c)
{
return(c.brightness);
}
private void cb3(cm msg)
{
cb(3, msg);
}
private void cb2(cm msg)
{
cb(2, msg);
}
private void cb1(cm msg)
{
cb(1, msg);
}
private void cb0(cm msg)
{
cb(0, msg);
}