/* * *  BlueZ - Bluetooth protocol stack for Linux * *  Copyright (C) 2004-2008  Marcel Holtmann <marcel@holtmann.org> * * *  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 2 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, write to the Free Software *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA * */#ifdef HAVE_CONFIG_H#include <config.h>#endif#include <stdio.h>#include <errno.h>#include <fcntl.h>#include <unistd.h>#include <string.h>#include <stdint.h>#include <termios.h>#include "csr.h"#include "ubcsp.h"static uint16_t seqnum = 0x0000;static int fd = -1;static struct ubcsp_packet send_packet;static uint8_t send_buffer[512];static struct ubcsp_packet receive_packet;static uint8_t receive_buffer[512];int csr_open_bcsp(char *device){	struct termios ti;	uint8_t delay, activity = 0x00;	int timeout = 0;	if (!device)		device = "/dev/ttyS0";	fd = open(device, O_RDWR | O_NOCTTY);	if (fd < 0) {		fprintf(stderr, "Can't open serial port: %s (%d)\n",						strerror(errno), errno);		return -1;	}	tcflush(fd, TCIOFLUSH);	if (tcgetattr(fd, &ti) < 0) {		fprintf(stderr, "Can't get port settings: %s (%d)\n",						strerror(errno), errno);		close(fd);		return -1;	}	cfmakeraw(&ti);	ti.c_cflag |=  CLOCAL;	ti.c_cflag &= ~CRTSCTS;	ti.c_cflag |=  PARENB;	ti.c_cflag &= ~PARODD;	ti.c_cflag &= ~CSIZE;	ti.c_cflag |=  CS8;	ti.c_cflag &= ~CSTOPB;	ti.c_cc[VMIN] = 1;	ti.c_cc[VTIME] = 0;	cfsetospeed(&ti, B38400);	if (tcsetattr(fd, TCSANOW, &ti) < 0) {		fprintf(stderr, "Can't change port settings: %s (%d)\n",						strerror(errno), errno);		close(fd);		return -1;	}	tcflush(fd, TCIOFLUSH);	if (fcntl(fd, F_SETFL, fcntl(fd, F_GETFL, 0) | O_NONBLOCK) < 0) {		fprintf(stderr, "Can't set non blocking mode: %s (%d)\n",						strerror(errno), errno);		close(fd);		return -1;	}	memset(&send_packet, 0, sizeof(send_packet));	memset(&receive_packet, 0, sizeof(receive_packet));	ubcsp_initialize();	send_packet.length = 512;	send_packet.payload = send_buffer;	receive_packet.length = 512;	receive_packet.payload = receive_buffer;	ubcsp_receive_packet(&receive_packet);	while (1) {		delay = ubcsp_poll(&activity);		if (activity & UBCSP_PACKET_RECEIVED)			break;		if (delay) {			usleep(delay * 100);			if (timeout++ > 100) {				fprintf(stderr, "Initialization timed out\n");				return -1;			}		}	}	return 0;}void put_uart(uint8_t ch){	if (write(fd, &ch, 1) < 0)		fprintf(stderr, "UART write error\n");}uint8_t get_uart(uint8_t *ch){	int res = read(fd, ch, 1);	return res > 0 ? res : 0;}static int do_command(uint16_t command, uint16_t seqnum, uint16_t varid, uint8_t *value, uint16_t length){	unsigned char cp[254], rp[254];	uint8_t cmd[10];	uint16_t size;	uint8_t delay, activity = 0x00;	int timeout = 0, sent = 0;	size = (length < 8) ? 9 : ((length + 1) / 2) + 5;	cmd[0] = command & 0xff;	cmd[1] = command >> 8;	cmd[2] = size & 0xff;	cmd[3] = size >> 8;	cmd[4] = seqnum & 0xff;	cmd[5] = seqnum >> 8;	cmd[6] = varid & 0xff;	cmd[7] = varid >> 8;	cmd[8] = 0x00;	cmd[9] = 0x00;	memset(cp, 0, sizeof(cp));	cp[0] = 0x00;	cp[1] = 0xfc;	cp[2] = (size * 2) + 1;	cp[3] = 0xc2;	memcpy(cp + 4, cmd, sizeof(cmd));	memcpy(cp + 14, value, length);	receive_packet.length = 512;	ubcsp_receive_packet(&receive_packet);	send_packet.channel  = 5;	send_packet.reliable = 1;	send_packet.length   = (size * 2) + 4;	memcpy(send_packet.payload, cp, (size * 2) + 4);	ubcsp_send_packet(&send_packet);	while (1) {		delay = ubcsp_poll(&activity);		if (activity & UBCSP_PACKET_RECEIVED) {			if (sent && receive_packet.channel == 5 &&					receive_packet.payload[0] == 0xff) {				memcpy(rp, receive_packet.payload,							receive_packet.length);				break;			}			receive_packet.length = 512;			ubcsp_receive_packet(&receive_packet);			timeout = 0;		}		if (activity & UBCSP_PACKET_SENT) {			switch (varid) {			case CSR_VARID_COLD_RESET:			case CSR_VARID_WARM_RESET:			case CSR_VARID_COLD_HALT:			case CSR_VARID_WARM_HALT:				return 0;			}			sent = 1;			timeout = 0;		}		if (delay) {			usleep(delay * 100);			if (timeout++ > 100) {				fprintf(stderr, "Operation timed out\n");				return -1;			}		}	}	if (rp[0] != 0xff || rp[2] != 0xc2) {		errno = EIO;		return -1;	}	if ((rp[11] + (rp[12] << 8)) != 0) {		errno = ENXIO;		return -1;	}	memcpy(value, rp + 13, length);	return 0;}int csr_read_bcsp(uint16_t varid, uint8_t *value, uint16_t length){	return do_command(0x0000, seqnum++, varid, value, length);}int csr_write_bcsp(uint16_t varid, uint8_t *value, uint16_t length){	return do_command(0x0002, seqnum++, varid, value, length);}void csr_close_bcsp(void){	close(fd);}