void InputDeviceSingleton::BeginJoystickCalibration()
{
int msgColor = makecol(255, 255, 255);
int bgColor = makecol(0, 0, 255);
// for each joystick, run a calibration sequence
for (int index = 0; index < num_joysticks; index++)
{
// clear the screen
clear_to_color(screen, bgColor);
// while the jostick needs to be calibrated
while (joy[index].flags & JOYFLAG_CALIBRATE)
{
// get the calibration message
const char* message = calibrate_joystick_name(index);
// show the message on the screen
textprintf_centre_ex(screen,
font, SCREEN_W / 2, SCREEN_H / 2,
msgColor,
-1,
"%s, and press a key.",
message);
// read a key
readkey();
// try to calibrate the joystick
if (0 != calibrate_joystick(index))
{
// show a message that we failed
textprintf_centre_ex(screen,
font, SCREEN_W / 2, 64 + (SCREEN_H / 2),
msgColor,
-1,
"Could not calibrate the Joystick!");
// read a key
readkey();
// and bail with a fatal error
LogFatal("Could not calibrate the joystick!");
}
}
}
// try to save the calibration data to a file
if (0 != save_joystick_data("joysettings.dat"))
{
// clear the screen to red
clear_to_color(screen, makecol(255, 0, 0));
// show a message on the screen
textprintf_centre_ex(screen,
font, SCREEN_W / 2, SCREEN_H / 2,
makecol(255, 255, 0),
-1,
"Joystick Calibration data file could not be saved! Press a key to exit the program.");
// read a key
readkey();
LogFatal("Joystick Calibration data file could not be saved! Program will now exit!");
}
// clear the screen
clear_to_color(screen, bgColor);
// show a message on the screen
textprintf_centre_ex(screen,
font, SCREEN_W / 2, SCREEN_H / 2,
msgColor,
-1,
"Joysticks have been calibrated. Press a key to exit the program.");
// read a key
readkey();
// log a message that the joysticks were calibrated
LogMessage("Joysticks calibrated! Program Exiting...");
exit(1);
}
int
main (int argc, char **argv)
{
int joy_count = 0;
Joystick *joy;
int n;
char *home;
home = getenv("HOME");
if (! home)
{
fprintf(stderr, "$HOME environment variable not set.\n");
exit(1);
}
for (joy = &joysticks[0], n = 0; n < N_ELEMENTS(joysticks); joy++, n++)
{
char devname[PATH_MAX];
joy->n = n;
snprintf(devname, sizeof(devname), "/dev/joy%i", n);
joy->fd = open(devname, O_RDONLY);
if (joy->fd < 0)
printf("Cannot open joystick %s: %s\n", devname, strerror(errno));
else
{
joy_count++;
calibrate_joystick(joy);
close(joy->fd);
}
}
if (joy_count == 0)
{
fprintf(stderr, "No joystick was found.\n");
exit(1);
}
for (joy = &joysticks[0], n = 0; n < N_ELEMENTS(joysticks); joy++, n++)
if (joy->fd >= 0)
{
FILE *f;
char filename[PATH_MAX];
snprintf(filename, sizeof(filename), "%s/.joy%irc", home, joy->n);
f = fopen(filename, "w");
if (! f)
{
fprintf(stderr, "Unable to open %s for writing: %s.\n", filename, strerror(errno));
exit(1);
}
if (fprintf(f, "16 %i %i %i %i %i %i",
joy->axes[0].min, joy->axes[0].center, joy->axes[0].max,
joy->axes[1].min, joy->axes[1].center, joy->axes[1].max) < 0)
{
fprintf(stderr, "Unable to write %s: %s.\n", filename, strerror(errno));
exit(1);
}
if (fclose(f) != 0)
{
fprintf(stderr, "Unable to close %s: %s.\n", filename, strerror(errno));
exit(1);
}
printf("Wrote %s.\n", filename);
}
return 0;
}
int
main (int argc, char *argv[])
{
int DesiredJoystick = 0, i, j, Joystick, Stick, Axis, Offset, Changed = 0;
float Factor;
char *s;
#ifdef WIN32
Out = stdout; // fopen ("yaACA.txt", "w");
#else
Out = stdout;
#endif
fprintf (Out, "Apollo Attitude Controller Assembly (ACA) emulation, version " NVER
", built " __DATE__ "\n");
fprintf (Out, "(c)2005,2009 Ronald S. Burkey\n");
fprintf (Out, "Refer to http://www.ibiblio.org/apollo/index.html for more information.\n");
fflush (Out);
// Initialize Allegro.
Retry:
allegro_init ();
if (install_joystick (JOY_TYPE_AUTODETECT) || num_joysticks <= 0)
{
fprintf (Out, "Couldn\'t find any joysticks. Retrying ...\n");
fflush (Out);
//return (1);
#ifdef WIN32
Sleep (5000);
#else // WIN32
{
struct timespec req, rem;
req.tv_sec = 5;
req.tv_nsec = 0;
nanosleep (&req, &rem);
}
#endif // WIN32
allegro_exit ();
goto Retry;
}
{
GetParameters (Controller);
//fprintf (Out, "%d joysticks found:\n", num_joysticks);
for (i = 0; i < num_joysticks; i++)
{
int k;
fprintf (Out, "Joystick device #%d:\n", i);
if (joy[i].flags & JOYFLAG_DIGITAL)
fprintf (Out, "\tThis control provides a digital input.\n");
else if (joy[i].flags & JOYFLAG_ANALOGUE)
fprintf (Out, "\tThis control provides an analog input.\n");
else if (joy[i].flags & JOYFLAG_CALIB_DIGITAL)
fprintf (Out, "\tThis control will provide a digital input after calibration.\n");
else if (joy[i].flags & JOYFLAG_CALIB_ANALOGUE)
fprintf (Out, "\tThis control will provide an analog input after calibration.\n");
else if (joy[i].flags & JOYFLAG_CALIBRATE)
fprintf (Out, "\tThis control needs calibration.\n");
else if (joy[i].flags & JOYFLAG_SIGNED)
fprintf (Out, "\tThis control provides signed data (i.e., -127 to 127).\n");
else if (joy[i].flags & JOYFLAG_UNSIGNED)
fprintf (Out, "\tThis control provides unsigned data (i.e., 0 to 255).\n");
for (j = 0; j < joy[i].num_sticks; j++)
{
fprintf (Out, "\tStick #%d of joystick device #%d:\n", j, i);
if (joy[i].stick[j].flags & JOYFLAG_DIGITAL)
fprintf (Out, "\t\tThis control provides a digital input.\n");
else if (joy[i].stick[j].flags & JOYFLAG_ANALOGUE)
fprintf (Out, "\t\tThis control provides an analog input.\n");
else if (joy[i].stick[j].flags & JOYFLAG_CALIB_DIGITAL)
fprintf (Out, "\t\tThis control will provide a digital input after calibration.\n");
else if (joy[i].stick[j].flags & JOYFLAG_CALIB_ANALOGUE)
fprintf (Out, "\t\tThis control will provide an analog input after calibration.\n");
else if (joy[i].stick[j].flags & JOYFLAG_CALIBRATE)
fprintf (Out, "\t\tThis control needs calibration.\n");
else if (joy[i].stick[j].flags & JOYFLAG_SIGNED)
fprintf (Out, "\t\tThis control provides signed data (i.e., -127 to 127).\n");
else if (joy[i].stick[j].flags & JOYFLAG_UNSIGNED)
fprintf (Out, "\t\tThis control provides unsigned data (i.e., 0 to 255).\n");
fprintf (Out, "\t\tDescription = %s\n", joy[i].stick[j].name);
for (k = 0; k < joy[i].stick[j].num_axis; k++)
fprintf (Out, "\t\tAxis #%d description = %s\n", k, joy[i].stick[j].axis[k].name);
}
for (j = 0; j < joy[i].num_buttons; j++)
{
fprintf (Out, "\tButton %d = %s\n", j, joy[i].button[j].name);
}
}
fprintf (Out, "\n");
fprintf (Out, "Note that only 3 degrees of freedom and no buttons are used by yaACA.\n");
fprintf (Out, "Right roll, upward pitch, and clockwise yaw are positive values.\n");
fprintf (Out, "Left roll, downward pitch, and counter-clockwise yaw are negative values.\n");
}
// Parse the command-line arguments.
for (i = 1; i < argc; i++)
{
if (!strcmp (argv[i], "--help"))
{
fprintf (Out,
"\n"
"USAGE:\n"
"\tyaACA [OPTIONS]\n"
"The recognized options are:\n"
"--help\n"
"\tDisplays this message.\n"
"--roll=J,S,A,F,O or --pitch=J,S,A,F,O or --yaw=J,S,A,F,O\n"
"\tThese options allow you to configure how the roll/pitch/yaw degrees\n"
"\tof freedom map to the characteristics of the joystick as recognized\n"
"\tby the computer's operating system. J is the joystick number (in \n"
"\tcase multiple joysticks are installed), S is the stick number within\n"
"\tthe joystick, and A is the axis within the stick. F is a factor which\n"
"\tthe joystick reading is multiplied by, and O is an offset added to the\n"
"\tjoystick reading (after multiplication is completed). The factor is \n"
"\tuseful (for example) in swapping right-to-left, back-to-front, or \n"
"\tclockwise-to-counter-clockwise. The offset would be useful when the\n"
"\tthe joystick provides unsigned readings (0-255) rather than the desired\n"
"\tsigned readings (-127 to 127). The defaults are:\n"
"\t\t\tRoll\t\t0,0,0,+1.0,0\n"
"\t\t\tPitch\t\t0,0,1,+1.0,0\n"
#ifdef __APPLE__
"\t\t\tYaw\t\t0,2,0,+1.0,%d\n"
#else
"\t\t\tYaw\t\t0,1,0,+1.0,%d\n"
#endif
"\t(By the way, the defaults work with a Logitech Extreme 3D Pro.)\n"
"\tAlthough it would appear that you can select a different joystick\n"
"\tcontroller (the first field) for each of the pitch/roll/yaw axes,\n"
"\tyou really cannot, so please do not do so. For versions 20090406\n"
"\tand later, your selections are automatically stored in a configuration\n"
"\tfile called yaACA-N.cfg, where N is the joystick controller number,\n"
"\tand become the new defaults the next time the program is run. In\n"
"\tother words, once you've determined the appropriate command-line\n"
"\tsettings for --roll, --pitch, and --yaw, you don't need to use the\n"
"\tcommand-line parameters again. An exception is if the joystick\n"
"\tcontroller-number is non-zero. If so, you will need to use at least\n"
"\tone of these command-line switches every time, or else the saved\n"
"\tsettings for controller 0 will be used.\n"
"--ip=Hostname\n"
"\tThe yaACA program and the yaAGC Apollo Guidance Computer simulation\n"
"\texist in a \"client/server\" relationship, in which the yaACA program\n"
"\tneeds to be aware of the IP address or symbolic name of the host\n"
"\tcomputer running the yaAGC program. By default, this is \"localhost\",\n"
"\tmeaning that both yaACA and yaAGC are running on the same computer.\n"
"--port=Portnumber\n"
"\tBy default, yaACA attempts to connect to the yaAGC program using port\n"
"\tnumber %d. However, if more than one instance of yaACA is being\n"
"\trun, or if yaAGC has been configured to listen on different ports, then\n"
"\tdifferent port settings for yaACA are needed. Note that by default,\n"
"\tyaAGC listens for new connections on ports 19697-19706, but that the\n"
"\trecommended port range when using yaAGC in the LM is 19797-19806.\n",
YawOffset, sPortnum
);
fprintf (Out, "--delay=N\n");
fprintf (Out, "\t\"Start-up delay\", in ms. Defaults to %d. What the start-up\n", StartupDelay);
fprintf (Out, "\tdelay does is to prevent yaACA from attempting to communicate with\n");
fprintf (Out, "\tyaAGC for a brief time after power-up. This option is really only\n");
fprintf (Out, "\tuseful in Win32, to work around a problem with race-conditions in\n");
fprintf (Out, "\tat start-up time.\n");
return (0);
}
else if (5 == sscanf (argv[i], "--roll=%d,%d,%d,%f,%d", &Joystick, &Stick, &Axis, &Factor, &Offset) ||
5 == sscanf (argv[i], "--pitch=%d,%d,%d,%f,%d", &Joystick, &Stick, &Axis, &Factor, &Offset) ||
5 == sscanf (argv[i], "--yaw=%d,%d,%d,%f,%d", &Joystick, &Stick, &Axis, &Factor, &Offset) )
{
if (Joystick >= 0 && Joystick < num_joysticks)
{
DesiredJoystick = Joystick;
if (Stick < 0 || Stick >= joy[Joystick].num_sticks)
{
fprintf (Out, "\nJoystick #%d stick numbers must be >=0 and < %d. Sorry!\n",
Joystick, joy[Joystick].num_sticks);
return (1);
}
if (Axis < 0 || Axis >= joy[Joystick].stick[Stick].num_axis)
{
fprintf (Out, "\nJoystick #%d, stick #%d axis numbers must be >=0 and < %d. Sorry!\n",
Joystick, Stick, joy[Joystick].stick[Stick].num_axis);
return (1);
}
if (0 == (JOYFLAG_ANALOGUE & joy[Joystick].stick[Stick].flags))
{
fprintf (Out, "\nJoystick #%d, stick #%d is not analog. Sorry!\n",
Joystick, Stick);
return (1);
}
if ('r' == argv[i][2])
{
Roll = &joy[Joystick].stick[Stick].axis[Axis].pos;
RollFactor = Factor;
RollOffset = Offset;
Controller = Joystick;
RollStick = Stick;
RollAxis = Axis;
Changed = 1;
}
else if ('p' == argv[i][2])
{
Pitch = &joy[Joystick].stick[Stick].axis[Axis].pos;
PitchFactor = Factor;
PitchOffset = Offset;
Controller = Joystick;
PitchStick = Stick;
PitchAxis = Axis;
Changed = 1;
}
else
{
Yaw = &joy[Joystick].stick[Stick].axis[Axis].pos;
YawFactor = Factor;
YawOffset = Offset;
Controller = Joystick;
YawStick = Stick;
YawAxis = Axis;
Changed = 1;
}
}
else
{
fprintf (Out, "\nJoystick numbers must be >= 0 and < %d. Sorry!\n", num_joysticks);
return (1);
}
}
else if (1 == sscanf (argv[i], "--delay=%d", &j))
StartupDelay = j;
else
{
fprintf (Out, "Unknown command-line switch \"%s\".\n", argv[i]);
fprintf (Out, "Try \"yaACA --help\".\n");
return (1);
}
}
if (Changed || !CfgExisted)
WriteParameters (Controller);
// Set up variables for quick access to just the desired joystick, and check for minimum
// requirements. Note that the ACA requires no pushbuttons (there are associated toggle
// switches, but they're not physically on the hand-control, and they are toggle switches
// anyhow).
s = (char *) calibrate_joystick_name (DesiredJoystick);
if (s != NULL)
{
fprintf (Out, "%s\n", calibrate_joystick_name (DesiredJoystick));
if (calibrate_joystick (DesiredJoystick))
{
fprintf (Out, "Joystick calibration problem.\n");
return (1);
}
}
PrintJoy ();
// Now we start polling the joystick from time to time. The way Allegro works is to
// maintain an array containing info on each joystick. This array is updated only when
// poll_joystick is called (which you have to do explicitly). To see what has changed,
// we maintain a copy of the joy[] array.
while (1)
{
// Sleep for a while so that this job won't monopolize CPU cycles.
#ifdef WIN32
Sleep (UPDATE_INTERVAL);
#else // WIN32
struct timespec req, rem;
req.tv_sec = 0;
req.tv_nsec = 1000000 * UPDATE_INTERVAL;
nanosleep (&req, &rem);
#endif // WIN32
poll_joystick (); // Get joystick values.
PrintJoy (); // Display them locally.
PulseACA (); // Manage server connection.
#if 0
{
static int Count = 0;
fprintf (Out, "*");
Count++;
if (Count >= 32)
{
Count = 0;
fflush (Out);
}
}
#endif
}
return (0);
}
