klipper/lib/hidflash/rs232.c

315 lines
7.0 KiB
C
Raw Normal View History

/*
***************************************************************************
*
* Author: Teunis van Beelen
*
* Copyright (C) 2005, 2006, 2007, 2008, 2009, 2010, 2011, 2012, 2013, 2014, 2015, 2016, 2017 Teunis van Beelen
*
* Email: teuniz@gmail.com
*
***************************************************************************
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>.
*
***************************************************************************
*/
/* Last revision: November 22, 2017 */
/* For more info and how to use this library, visit: http://www.teuniz.net/RS-232/ */
#include "rs232.h"
#include <string.h>
#include <stdio.h>
#if defined(__linux__) || defined(__FreeBSD__) || defined(__APPLE__) /* Linux & FreeBSD */
int tty_fd;
struct termios old_termios;
struct termios new_termios;
int RS232_OpenComport(char *comport) {
char str[64]= "/dev/";
strcat(str, comport);
tty_fd = open(str, O_RDWR | O_NOCTTY);
if (tty_fd < 0) {
fprintf(stderr, "error, counldn't open [%s]\n", str);
return 1;
}
if (tcgetattr(tty_fd, &old_termios) != 0) {
fprintf(stderr, "tcgetattr(fd, &old_termios) failed: %s\n", strerror(errno));
return 1;
}
memset(&new_termios, 0, sizeof(new_termios));
new_termios.c_iflag = IGNPAR;
new_termios.c_oflag = 0;
new_termios.c_cflag = CS8 | CREAD | CLOCAL | HUPCL;
new_termios.c_lflag = 0;
new_termios.c_cc[VINTR] = 0;
new_termios.c_cc[VQUIT] = 0;
new_termios.c_cc[VERASE] = 0;
new_termios.c_cc[VKILL] = 0;
new_termios.c_cc[VEOF] = 4;
new_termios.c_cc[VTIME] = 0;
new_termios.c_cc[VMIN] = 1;
//new_termios.c_cc[VSWTC] = 0;
new_termios.c_cc[VSTART] = 0;
new_termios.c_cc[VSTOP] = 0;
new_termios.c_cc[VSUSP] = 0;
new_termios.c_cc[VEOL] = 0;
new_termios.c_cc[VREPRINT] = 0;
new_termios.c_cc[VDISCARD] = 0;
new_termios.c_cc[VWERASE] = 0;
new_termios.c_cc[VLNEXT] = 0;
new_termios.c_cc[VEOL2] = 0;
if (cfsetispeed(&new_termios, B1200) != 0) {
fprintf(stderr, "cfsetispeed(&new_termios, B1200) failed: %s\n", strerror(errno));
return 1;
}
if (cfsetospeed(&new_termios, B1200) != 0) {
fprintf(stderr, "cfsetospeed(&new_termios, B1200) failed: %s\n", strerror(errno));
return 1;
}
if (tcsetattr(tty_fd, TCSANOW, &new_termios) != 0) {
fprintf(stderr, "tcsetattr(fd, TCSANOW, &new_termios) failed: %s\n", strerror(errno));
return 1;
}
return 0;
//======================================================================================
}
int RS232_SendByte(unsigned char byte) {
int n = write(tty_fd, &byte, 1);
if(n < 0) {
if(errno == EAGAIN) {
return 0;
} else {
return 1;
}
}
return(0);
}
/*
int RS232_ReadByte() {
unsigned char c;
if (read(tty_fd,&c,1)>0) {
return c;
}
return -1;
}
*/
void RS232_CloseComport() {
tcsetattr(tty_fd, TCSANOW, &old_termios);
close(tty_fd);
}
void RS232_enableDTR() {
int status;
if(ioctl(tty_fd, TIOCMGET, &status) == -1) {
perror("unable to get portstatus");
}
status |= TIOCM_DTR; /* turn on DTR */
if(ioctl(tty_fd, TIOCMSET, &status) == -1) {
perror("unable to set portstatus");
}
}
void RS232_disableDTR()
{
int status;
if(ioctl(tty_fd, TIOCMGET, &status) == -1) {
perror("unable to get portstatus");
}
status &= ~TIOCM_DTR; /* turn off DTR */
if(ioctl(tty_fd, TIOCMSET, &status) == -1) {
perror("unable to set portstatus");
}
}
void RS232_enableRTS()
{
int status;
if(ioctl(tty_fd, TIOCMGET, &status) == -1) {
perror("unable to get portstatus");
}
status |= TIOCM_RTS; /* turn on RTS */
if(ioctl(tty_fd, TIOCMSET, &status) == -1) {
perror("unable to set portstatus");
}
}
void RS232_disableRTS() {
int status;
if(ioctl(tty_fd, TIOCMGET, &status) == -1) {
perror("unable to get portstatus");
}
status &= ~TIOCM_RTS; /* turn off RTS */
if(ioctl(tty_fd, TIOCMSET, &status) == -1) {
perror("unable to set portstatus");
}
}
void RS232_send_magic(){
write(tty_fd,"1EAF",4);
}
#else /* windows */
HANDLE Cport;
char mode_str_2[] = "baud=9600 data=8 parity=n stop=1 dtr=off rts=off";
int RS232_OpenComport(char *comport)
{
//printf("%s\n %s\n %s\n %p\n", mode_str_2, comports[comport_number], comport, Cport);
char str[32] = "\\\\.\\";
strcat(str, comport);
//printf("%s\n", str);
Cport = CreateFileA(str,
GENERIC_READ|GENERIC_WRITE,
0, /* no share */
NULL, /* no security */
OPEN_EXISTING,
0, /* no threads */
NULL); /* no templates */
if(Cport==INVALID_HANDLE_VALUE)
{
//printf("> unable to open comport\n");
return(1);
}
DCB port_settings;
memset(&port_settings, 0, sizeof(port_settings)); /* clear the new struct */
port_settings.DCBlength = sizeof(port_settings);
if(!BuildCommDCBA(mode_str_2, &port_settings))
{
printf("> unable to set comport dcb settings\n");
CloseHandle(Cport);
return(1);
}
if(!SetCommState(Cport, &port_settings))
{
printf("> unable to set comport cfg settings\n");
CloseHandle(Cport);
return(1);
}
COMMTIMEOUTS Cptimeouts;
Cptimeouts.ReadIntervalTimeout = MAXDWORD;
Cptimeouts.ReadTotalTimeoutMultiplier = 0;
Cptimeouts.ReadTotalTimeoutConstant = 0;
Cptimeouts.WriteTotalTimeoutMultiplier = 0;
Cptimeouts.WriteTotalTimeoutConstant = 0;
if(!SetCommTimeouts(Cport, &Cptimeouts))
{
printf("> unable to set comport time-out settings\n");
CloseHandle(Cport);
return(1);
}
return(0);
}
int RS232_SendByte(unsigned char byte)
{
int n;
WriteFile(Cport, &byte, 1, (LPDWORD)((void *)&n), NULL);
if(n<0) return(1);
return(0);
}
void RS232_CloseComport()
{
CloseHandle(Cport);
}
void RS232_enableDTR()
{
EscapeCommFunction(Cport, SETDTR);
}
void RS232_disableDTR()
{
EscapeCommFunction(Cport, CLRDTR);
}
void RS232_enableRTS()
{
EscapeCommFunction(Cport, SETRTS);
}
void RS232_disableRTS()
{
EscapeCommFunction(Cport, CLRRTS);
}
void RS232_send_magic()
{
int n;
WriteFile(Cport, "1EAF", 4, (LPDWORD)((void *)&n), NULL);
}
#endif