implement LPT pin "reset" function
This commit is contained in:
parent
8f39695140
commit
75c7a1be71
25
yasnd.c
25
yasnd.c
@ -1,5 +1,6 @@
|
|||||||
#include <sys/types.h>
|
#include <sys/types.h>
|
||||||
#include <sys/stat.h>
|
#include <sys/stat.h>
|
||||||
|
#include <sys/io.h>
|
||||||
#include <sys/wait.h>
|
#include <sys/wait.h>
|
||||||
#include <stdio.h>
|
#include <stdio.h>
|
||||||
#include <stdlib.h>
|
#include <stdlib.h>
|
||||||
@ -130,6 +131,30 @@ void check_host(int num,host_decl* host)
|
|||||||
host->helper_pid=pid;
|
host->helper_pid=pid;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
Function, that turn on only one LPT port pin, defined by it argument, wait a second,
|
||||||
|
and turn off all pins. That is enough to reset specified host.
|
||||||
|
*/
|
||||||
|
void reset_pin(int pin_num)
|
||||||
|
{
|
||||||
|
if (pin_num<1 || pin_num>8)
|
||||||
|
{
|
||||||
|
log_event("Error: incorrent LPT pin number");
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
#define LPTPORT 0x378
|
||||||
|
int pins = 2<<(pin_num-1);
|
||||||
|
if (ioperm (LPTPORT, 3, 1))
|
||||||
|
{
|
||||||
|
log_event("Error: LPT port access error");
|
||||||
|
exit(EXIT_FAILURE);
|
||||||
|
}
|
||||||
|
// Reset host
|
||||||
|
outb (pins, LPTPORT);
|
||||||
|
sleep(1);
|
||||||
|
outb (0, LPTPORT);
|
||||||
|
}
|
||||||
|
|
||||||
void loop_function()
|
void loop_function()
|
||||||
{
|
{
|
||||||
for (int i=0;i<hosts_count;i++)
|
for (int i=0;i<hosts_count;i++)
|
||||||
|
Loading…
Reference in New Issue
Block a user