Svenska ElektronikForumet

Kod: Markera allt

#include <unistd.h>
#include <stdio.h>
#include <stdlib.h>
#include <termios.h>
#include <fcntl.h>
#include <errno.h>
#include <limits.h>

FILE *uart_linux_str;

/* Use this variable to remember original terminal attributes. */
struct termios saved_attributes;

void reset_input_mode(void)
{
	tcsetattr(STDIN_FILENO, TCSANOW, &saved_attributes);
}

/* Set the O_NONBLOCK flag of desc if value is nonzero,
or clear the flag if value is 0.
Return 0 on success, or -1 on error with errno set. */
int set_nonblock_flag (int desc, int value)
{
	int oldflags = fcntl(desc, F_GETFL, 0);

	/* If reading the flags failed, return error indication now. */
	if (oldflags == -1)
		return -1;

	/* Set just the flag we want to set. */
	if (value != 0)
		oldflags |= O_NONBLOCK;
	else
		oldflags &= ~O_NONBLOCK;

	/* Store modified flag word in the descriptor. */
	return fcntl (desc, F_SETFL, oldflags);
}

int uart_linux_init(void)
{
	int uart_linux_str_fd;
	struct termios tattr;
	
	if (!(uart_linux_str = fopen("/dev/ttyAMA0","w+b")))
	{
		fputs("Error can't create uart_linux stream\n",stderr);
		return -1;
	}	

	uart_linux_str_fd = fileno(uart_linux_str);
	set_nonblock_flag (uart_linux_str_fd,1);
	tcgetattr(uart_linux_str_fd, &tattr);
	cfmakeraw(&tattr);
	cfsetospeed(&tattr,B9600);
	tcsetattr(uart_linux_str_fd, TCSAFLUSH, &tattr);
	
	return 0;
}