void
vHelpDone(
HWND hWnd, /* Required to allow us to clean up nicely */
BOOL bInitHelpFileOnly
)
{
--cHelpInit;
if( cHelpInit == 0 )
{
if (!bInitHelpFileOnly)
{
/* Does the right thing for help to go away, if shown */
vShowHelp( hWnd, HELP_QUIT, 0L, NULL );
UnhookWindowsHookEx( hhookGetMsg );
}
if( pwszHelpFile )
{
HeapFree( hHeap, 0, (LPSTR)pwszHelpFile );
pwszHelpFile = NULL;
}
}
else if( cHelpInit < 0 )
cHelpInit = 0; /* Should never happen, but.... */
return;
}
/* ==================================================================================================== */
int main(int argc, char** argv)
{
/* Helpers */
int opt = 0;
int dev_count = 0;
bool setup_io = false;
bool verbose = false;
bool show_help = false;
bool turn_off = false;
/* Etherbone */
static eb_device_t device;
eb_socket_t socket;
eb_status_t status;
struct sdb_device devices[WB_IO_CONTROL_MAX_DEVICES];
uint32_t wb_addr_base;
/* Get the application name */
program = argv[0];
/* Parse for options */
while ((opt = getopt(argc, argv, ":svho")) != -1)
{
switch (opt)
{
case 's': { setup_io = true; break; }
case 'v': { verbose = true; break; }
case 'h': { show_help = true; break; }
case 'o': { turn_off = true; break; }
default: { printf("Unknown argument...\n"); show_help = true; break; }
}
}
/* Get basic arguments, we need at least the device name */
if (optind + 1 == argc)
{
devName = argv[optind];
}
else
{
show_help = true;
printf("Incorrect non-optional arguments...\n");
}
/* Show help? */
if (show_help) { vShowHelp(); return -1; }
/* Open socket and device */
if ((status = eb_socket_open(EB_ABI_CODE, 0, EB_DATAX|EB_ADDRX, &socket)) != EB_OK) { vHandleEBError("eb_socket_open", status); }
if ((status = eb_device_open(socket, devName, EB_DATAX|EB_ADDRX, 3, &device)) != EB_OK) { vHandleEBError(devName, status); }
/* Try to find the IO CONTROL module */
dev_count = WB_IO_CONTROL_MAX_DEVICES;
if ((status = eb_sdb_find_by_identity(device, WB_IO_CONTROL_VENDOR_ID, WB_IO_CONTROL_PRODUCT_ID, &devices[0], &dev_count)) != EB_OK)
{
vHandleEBError("eb_sdb_find_by_identity", status);
}
/* Did we find at least one? */
if (dev_count != WB_IO_CONTROL_MAX_DEVICES)
{
printf("IO CONTROL unit missing!\n"); return -1;
}
else
{
wb_addr_base = (eb_address_t)(devices[0].sdb_component.addr_first);
if (verbose) { printf("Found IO CONTROL unit at 0x%08x (%d)\n", wb_addr_base, dev_count); }
}
/* Configure unit */
if (!turn_off)
{
printf("Enabling PPS...\n");
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_GPIO_PPS_Mux_Set_low, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_GPIO_PPS_Mux_Set_high, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_LVDS_PPS_Mux_Set_low, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_LVDS_PPS_Mux_Set_high, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
if (setup_io)
{
printf("Enabling output...\n");
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_GPIO_Oe_Set_low, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_GPIO_Oe_Set_high, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_LVDS_Oe_Set_low, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_LVDS_Oe_Set_high, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_GPIO_Term_Reset_low, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_GPIO_Term_Reset_high, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_LVDS_Term_Reset_low, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_LVDS_Term_Reset_high, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
}
}
else
{
printf("Disabling PPS...\n");
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_GPIO_PPS_Mux_Reset_low, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_GPIO_PPS_Mux_Reset_high, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_LVDS_PPS_Mux_Reset_low, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_LVDS_PPS_Mux_Reset_high, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
if (setup_io)
{
printf("Disabling output...\n");
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_GPIO_Oe_Reset_low, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_GPIO_Oe_Reset_high, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_LVDS_Oe_Reset_low, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_LVDS_Oe_Reset_high, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_GPIO_Term_Set_low, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_GPIO_Term_Set_high, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_LVDS_Term_Set_low, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
eb_device_write(device, wb_addr_base + WB_IO_CONTROL_LVDS_Term_Set_high, EB_DATA32, WB_IO_CONTROL_MASK_ALL, 0, NULL);
}
}
/* Done */
return 0;
}
