bool Vantage::Disconnect()
{
if (PortFD >0)
tty_disconnect(PortFD);
return true;
}
/*
Inform Max Dome from a disconection and closes serial port
@param fd File descriptor
@return 0 Ok,
*/
int Disconnect_MaxDomeII(int fd)
{
Exit_Shutter_MaxDomeII(fd); // Really don't know why this is needed, but ASCOM driver does it.
tty_disconnect(fd);
return 0;
}
bool XAGYLWheel::Disconnect()
{
if (!sim)
tty_disconnect(PortFD);
DEBUG(INDI::Logger::DBG_SESSION,"XAGYL is offline.");
return true;
}
bool FlipFlat::Disconnect()
{
tty_disconnect(PortFD);
DEBUGF(INDI::Logger::DBG_SESSION,"%s is offline.", getDeviceName());
return true;
}
int tty_connect(const char *device, int bit_rate, int word_size, int parity, int stop_bits, int *fd)
{
#ifdef _WIN32
return TTY_PORT_FAILURE;
#else
int t_fd=-1;
char msg[80];
int bps;
struct termios tty_setting;
if ( (t_fd = open(device, O_RDWR | O_NOCTTY )) == -1)
{
*fd = -1;
return TTY_PORT_FAILURE;
}
/* Control Modes
Set bps rate */
switch (bit_rate) {
case 0:
bps = B0;
break;
case 50:
bps = B50;
break;
case 75:
bps = B75;
break;
case 110:
bps = B110;
break;
case 134:
bps = B134;
break;
case 150:
bps = B150;
break;
case 200:
bps = B200;
break;
case 300:
bps = B300;
break;
case 600:
bps = B600;
break;
case 1200:
bps = B1200;
break;
case 1800:
bps = B1800;
break;
case 2400:
bps = B2400;
break;
case 4800:
bps = B4800;
break;
case 9600:
bps = B9600;
break;
case 19200:
bps = B19200;
break;
case 38400:
bps = B38400;
break;
case 57600:
bps = B57600;
break;
case 115200:
bps = B115200;
break;
case 230400:
bps = B230400;
break;
default:
if (snprintf(msg, sizeof(msg), "tty_connect: %d is not a valid bit rate.", bit_rate) < 0)
perror(NULL);
else
perror(msg);
return TTY_PARAM_ERROR;
}
if ((cfsetispeed(&tty_setting, bps) < 0) ||
(cfsetospeed(&tty_setting, bps) < 0))
{
perror("tty_connect: failed setting bit rate.");
return TTY_PORT_FAILURE;
}
/* Control Modes
set no flow control word size, parity and stop bits.
Also don't hangup automatically and ignore modem status.
Finally enable receiving characters. */
tty_setting.c_cflag &= ~(CSIZE | CSTOPB | PARENB | PARODD | HUPCL | CRTSCTS);
tty_setting.c_cflag |= (CLOCAL | CREAD);
/* word size */
switch (word_size) {
case 5:
tty_setting.c_cflag |= CS5;
break;
case 6:
tty_setting.c_cflag |= CS6;
break;
case 7:
tty_setting.c_cflag |= CS7;
break;
case 8:
tty_setting.c_cflag |= CS8;
break;
default:
fprintf( stderr, "Default\n") ;
if (snprintf(msg, sizeof(msg), "tty_connect: %d is not a valid data bit count.", word_size) < 0)
perror(NULL);
else
perror(msg);
return TTY_PARAM_ERROR;
}
/* parity */
switch (parity) {
case PARITY_NONE:
break;
case PARITY_EVEN:
tty_setting.c_cflag |= PARENB;
break;
case PARITY_ODD:
tty_setting.c_cflag |= PARENB | PARODD;
break;
default:
fprintf( stderr, "Default1\n") ;
if (snprintf(msg, sizeof(msg), "tty_connect: %d is not a valid parity selection value.", parity) < 0)
perror(NULL);
else
perror(msg);
return TTY_PARAM_ERROR;
}
/* stop_bits */
switch (stop_bits) {
case 1:
break;
case 2:
tty_setting.c_cflag |= CSTOPB;
break;
default:
fprintf( stderr, "Default2\n") ;
if (snprintf(msg, sizeof(msg), "tty_connect: %d is not a valid stop bit count.", stop_bits) < 0)
perror(NULL);
else
perror(msg);
return TTY_PARAM_ERROR;
}
/* Control Modes complete */
/* Ignore bytes with parity errors and make terminal raw and dumb.*/
tty_setting.c_iflag &= ~(PARMRK | ISTRIP | IGNCR | ICRNL | INLCR | IXOFF | IXON | IXANY);
tty_setting.c_iflag |= INPCK | IGNPAR | IGNBRK;
/* Raw output.*/
tty_setting.c_oflag &= ~(OPOST | ONLCR);
/* Local Modes
Don't echo characters. Don't generate signals.
Don't process any characters.*/
tty_setting.c_lflag &= ~(ICANON | ECHO | ECHOE | ISIG | IEXTEN | NOFLSH | TOSTOP);
tty_setting.c_lflag |= NOFLSH;
/* blocking read until 1 char arrives */
tty_setting.c_cc[VMIN] = 1;
tty_setting.c_cc[VTIME] = 0;
/* now clear input and output buffers and activate the new terminal settings */
tcflush(t_fd, TCIOFLUSH);
if (tcsetattr(t_fd, TCSANOW, &tty_setting))
{
perror("tty_connect: failed setting attributes on serial port.");
tty_disconnect(t_fd);
return TTY_PORT_FAILURE;
}
*fd = t_fd;
/* return success */
return TTY_OK;
#endif
}
bool ShelyakEshel::Disconnect()
{
tty_disconnect(PortFD);
LOGF_INFO("%s is offline.", getDeviceName());
return true;
}
bool NFocus::Disconnect()
{
tty_disconnect(PortFD);
IDMessage(getDeviceName(), "NFocus is offline.");
return true;
}
