SoftwareDesign
/
csu3_am335x


			
							123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506
							<?xml version='1.0' encoding='iso-8859-1'?>
<!doctype html public '-//W3C//DTD XHTML 1.0 Strict//EN' 'http://www.w3.org/TR/xhtml1/DTD/xhtml1-strict.dtd'>
<html xmlns='http://www.w3c.org/1999/xhtml' lang='en-us'>
	<head>
		<title>
			serial.c
			</title>
		<meta http-equiv='content-type' content='text/html;iso-8859-1'/>
		<meta name='generator' content='motley-tools 1.9.4 13:40:33 Feb 18 2015'/>
		<meta name='author' content='cmaier@cmassoc.net'/>
		<meta name='robots' content='noindex,nofollow'/>
		<link href='toolkit.css' rel='stylesheet' type='text/css'/>
		</head>
	<body>
		<div class='headerlink'>
			[<a href='sendpacket.c.html' title=' sendpacket.c '>PREV</a>]
			[<a href='toolkit.html' title=' Index '>HOME</a>]
			[<a href='set32bitmap.c.html' title=' set32bitmap.c '>NEXT</a>]
			</div>
<pre>
/*====================================================================*
 *
 *   Copyright (c) 2013 Qualcomm Atheros, Inc.
 *
 *   All rights reserved.
 *
 *   Redistribution and use in source and binary forms, with or 
 *   without modification, are permitted (subject to the limitations 
 *   in the disclaimer below) provided that the following conditions 
 *   are met:
 *
 *   * Redistributions of source code must retain the above copyright 
 *     notice, this list of conditions and the following disclaimer.
 *
 *   * Redistributions in binary form must reproduce the above 
 *     copyright notice, this list of conditions and the following 
 *     disclaimer in the documentation and/or other materials 
 *     provided with the distribution.
 *
 *   * Neither the name of Qualcomm Atheros nor the names of 
 *     its contributors may be used to endorse or promote products 
 *     derived from this software without specific prior written 
 *     permission.
 *
 *   NO EXPRESS OR IMPLIED LICENSES TO ANY PARTY'S PATENT RIGHTS ARE 
 *   GRANTED BY THIS LICENSE. THIS SOFTWARE IS PROVIDED BY THE 
 *   COPYRIGHT HOLDERS AND CONTRIBUTORS &quot;AS IS&quot; AND ANY EXPRESS OR 
 *   IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 
 *   WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 
 *   PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER 
 *   OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 
 *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 
 *   NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 
 *   LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 
 *   HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 
 *   CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE 
 *   OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 
 *   SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.  
 *
 *--------------------------------------------------------------------*/

/*====================================================================*
 *
 *   serial.c - Atheros Serial Line Command Buffer Management;
 *
 *   serial.h
 *
 *   this module contains a serial line command buffer and functions
 *   to encode and decode it in different formats and send or receive
 *   it over the serial line;
 *
 *   Contributor(s):
 *	Charles Maier &lt;cmaier@qca.qualcomm.com&gt;
 *
 *--------------------------------------------------------------------*/

#ifndef SERIAL_SOURCE
#define SERIAL_SOURCE

/*====================================================================*
 *   system header files;
 *--------------------------------------------------------------------*/

#include &lt;unistd.h&gt;
#include &lt;stdlib.h&gt;
#include &lt;stdint.h&gt;
#include &lt;memory.h&gt;
#include &lt;errno.h&gt;

#if defined (WIN32)
#include &lt;Windows.h&gt;
#endif

/*====================================================================*
 *   custom header files;
 *--------------------------------------------------------------------*/

#include &quot;../serial/serial.h&quot;
#include &quot;../tools/number.h&quot;
#include &quot;../tools/types.h&quot;
#include &quot;../tools/flags.h&quot;
#include &quot;../tools/error.h&quot;

/*====================================================================*
 *   private variables;
 *--------------------------------------------------------------------*/

struct command command;

/*====================================================================*
 *
 *   void clearcommand ();
 *
 *   serial.h
 *
 *   erase the current command by writing 0s;
 *
 *--------------------------------------------------------------------*/

void clearcommand ()

{
	extern struct command command;
	memset (&amp;command, 0, sizeof (command));
	return;
}

/*====================================================================*
 *
 *   void sendcommand (struct _file_ * port, flag_t flags);
 *
 *   serial.h
 *
 *   echo then send the command;
 *
 *--------------------------------------------------------------------*/

void sendcommand (struct _file_ * port, flag_t flags)

{
	extern struct command command;
	if (_anyset (flags, UART_VERBOSE))
	{
		write (STDERR_FILENO, command.buffer, command.length);
		write (STDERR_FILENO, &quot;\n&quot;, sizeof (char));
	}
	if (write (port-&gt;file, command.buffer, command.length) != (signed)(command.length))
	{
		error (1, errno, &quot;Can't write to %s&quot;, port-&gt;name);
	}
	clearcommand ();
	return;
}

/*====================================================================*
 *
 *   void readcommand (struct _file_ * port, flag_t flags);
 *
 *   serial.h
 *
 *   read response serial line and log the response;
 *
 *--------------------------------------------------------------------*/

void readcommand (struct _file_ * port, flag_t flags)

{
	extern struct command command;

#if defined (WIN32)

	PAUSE (250);
	memset (&amp;command, 0, sizeof (command));
	command.length = read (port-&gt;file, command.buffer, sizeof (command.buffer));
	if (command.length &lt; 0)
	{
		error (1, errno, &quot;Bad response from %s&quot;, port-&gt;name);
	}
	if (command.length == 0)
	{
		error (1, errno, &quot;No response from %s&quot;, port-&gt;name);
	}

#else

	struct timeval tv;
	fd_set rfd;
	ssize_t tmp;
	memset (&amp;command, 0, sizeof (command));
	while (!strchr (command.buffer, '\r'))
	{
		tv.tv_sec = 1;
		tv.tv_usec = 0;
		FD_ZERO (&amp;rfd);
		FD_SET (port-&gt;file, &amp;rfd);
		if (select (port-&gt;file + 1, &amp;rfd, NULL, NULL, &amp;tv) != 1)
		{
			error (1, errno, &quot;Read timeout&quot;);
		}
		tmp = read (port-&gt;file, command.buffer + command.length, sizeof (command.buffer) - command.length - 1);
		if (tmp &lt; 0)
		{
			error (1, errno, &quot;Could not read %s&quot;, port-&gt;name);
		}
		command.length += tmp;
		command.buffer [command.length] = '\0';
	}

#endif

	if (_anyset (flags, UART_VERBOSE))
	{
		write (STDERR_FILENO, command.buffer, command.length);
		write (STDERR_FILENO, &quot;\n&quot;, sizeof (char));
	}
	if (!memcmp (command.buffer, &quot;ERROR&quot;, 5))
	{
		error (1, ECANCELED, &quot;Device refused request&quot;);
	}
	return;
}

/*====================================================================*
 *
 *   void insert (char c);
 *
 *   serial.h
 *
 *   insert a character into the command buffer at the current buffer
 *   position then increment the buffer position pointer;
 *
 *--------------------------------------------------------------------*/

void insert (char c)

{
	extern struct command command;
	if (command.length &lt; sizeof (command.buffer))
	{
		command.buffer [command.length++] = c;
	}
	return;
}

/*====================================================================*
 *
 *   unsigned readframe (signed fd, void * memory, size_t extent);
 *
 *   serial.h
 *
 *   read a file and convert hexadecimal octets to binary bytes then
 *   store them in consecutive memory locations up to a given length;
 *   return the actual number of bytes stored;
 *
 *   digits may be consecutive or separated by white space consisting
 *   of spaces, tabs, linefeeds, carriage returns, formfeeds or other
 *   characters such as punctuation; script-style comments are treated
 *   as white space;
 *
 *--------------------------------------------------------------------*/

static signed fdgetc (signed fd)

{
	char c;
	return ((read (fd, &amp;c, sizeof (c)) == sizeof (c))? c: EOF);
}

size_t readframe (signed fd, void * memory, size_t extent)

{
	unsigned digits = 0;
	uint8_t * origin = (uint8_t *)(memory);
	uint8_t * offset = (uint8_t *)(memory);
	signed c = EOF;
	while ((extent) &amp;&amp; ((c = fdgetc (fd)) != EOF) &amp;&amp; (c != ';'))
	{
		if (isspace (c))
		{
			continue;
		}
		if (c == '#')
		{
			do
			{
				c = fdgetc (fd);
			}
			while ((c != '\n') &amp;&amp; (c != EOF));
			continue;
		}
		if (c == '/')
		{
			c = fdgetc (fd);
			if (c == '/')
			{
				do
				{
					c = fdgetc (fd);
				}
				while ((c != '\n') &amp;&amp; (c != EOF));
				continue;
			}
			if (c == '*')
			{
				while ((c != '/') &amp;&amp; (c != EOF))
				{
					while ((c != '*') &amp;&amp; (c != EOF))
					{
						c = fdgetc (fd);
					}
					c = fdgetc (fd);
				}
				continue;
			}
			continue;
		}
		if (isxdigit (c))
		{
			*offset = c;
			offset++;
			digits++;
			extent--;
			continue;
		}
		error (1, ENOTSUP, &quot;Illegal hex digit '%c' (0x%02X) in source&quot;, c, c);
	}
	if (digits &amp; 1)
	{
		error (1, ENOTSUP, &quot;Odd number of hex digits (%d) in source&quot;, digits);
	}
	return (offset - origin);
}

/*====================================================================*
 *
 *   void decode (void const * memory, size_t extent);
 *
 *   serial.h
 *
 *   copy a memory region into command buffer at the current position
 *   and increment the buffer position pointer; convert bytes to hex
 *   octets;
 *
 *--------------------------------------------------------------------*/

void decode (void const * memory, size_t extent)

{
	extern struct command command;
	register byte * binary = (byte *)(memory);
	while ((command.length &lt; sizeof (command.buffer)) &amp;&amp; (extent--))
	{
		insert (DIGITS_HEX [(*binary &gt;&gt; 4) &amp; 0x0F]);
		insert (DIGITS_HEX [(*binary &gt;&gt; 0) &amp; 0x0F]);
		binary++;
	}
	return;
}

/*====================================================================*
 *
 *   void encode (void * memory, size_t extent);
 *
 *   serial.h
 *
 *   encode a memory region from the current command buffer position
 *   and increment the command buffer position pointer;
 *
 *--------------------------------------------------------------------*/

void encode (void * memory, size_t extent)

{
	extern struct command command;
	register byte * binary = (byte *)(memory);
	unsigned digit;
	while ((command.offset &lt; command.length) &amp;&amp; (extent--))
	{
		*binary = 0;
		if ((digit = todigit (command.buffer [command.offset++])) &gt; 0x0F)
		{
			command.buffer [command.offset] = (char)(0);
			error (1, EINVAL, &quot;[%s]1&quot;, command.buffer);
		}
		*binary |= digit &lt;&lt; 4;
		if ((digit = todigit (command.buffer [command.offset++])) &gt; 0x0F)
		{
			command.buffer [command.offset] = (char)(0);
			error (1, EINVAL, &quot;[%s]2&quot;, command.buffer);
		}
		*binary |= digit;
		binary++;
	}
	return;
}

/*====================================================================*
 *
 *   void string (char * string);
 *
 *   serial.h
 *
 *   extract the contents of a quoted string string from the command
 *   buffer; it assumes that the current char is a quote character;
 *
 *   copy command buffer characters to an external string; start a the
 *   current buffer position and continue until the buffer exhausts or
 *   a closing quote is encountered; NUL terminate the string;
 *
 *--------------------------------------------------------------------*/

void string (char * string)

{
	extern struct command command;
	while ((command.offset &lt; command.length) &amp;&amp; (command.buffer [command.offset] != '\&quot;'))
	{
		*string++ = command.buffer [command.offset++];
	}
	*string = (char)(0);
	return;
}

/*====================================================================*
 *
 *   uint64_t hextoint (unsigned bytes);
 *
 *   serial.h
 *
 *   this function is used to extract a hexadecimal integer string as
 *   an integer of specified length; an error occurs of the string is
 *   to long for the specified integer size in bytes;
 *
 *--------------------------------------------------------------------*/

uint64_t hextoint (unsigned bytes)

{
	extern struct command command;
	uint64_t limit = -1;
	uint64_t value = 0;
	unsigned radix = 16;
	unsigned digit = 0;
	if (bytes &lt; sizeof (limit))
	{
		limit &lt;&lt;= (bytes &lt;&lt; 3);
		limit = ~limit;
	}
	while ((digit = todigit (command.buffer [command.offset])) &lt; radix)
	{
		value *= radix;
		value += digit;
		command.offset++;
		if (value &gt; limit)
		{
			command.buffer [command.offset] = (char)(0);
			error (1, EINVAL, &quot;[%s] exceeds %d bits&quot;, command.buffer, (bytes &lt;&lt; 3));
		}
	}
	return (value);
}

/*====================================================================*
 *
 *   void mustbe (char c);
 *
 *   serial.h
 *
 *   test the character at the current buffer position; advance the
 *   buffer position pointer and return true on match; terminate the
 *   program on mismatch or exhausted buffer;
 *
 *--------------------------------------------------------------------*/

void mustbe (char c)

{
	extern struct command command;
	if (command.offset &gt;= command.length)
	{
		command.buffer [command.offset] = (char)(0);
		error (1, EINVAL, &quot;[%s]: overflow&quot;, command.buffer);
	}
	if (command.buffer [command.offset++] != (c))
	{
		command.buffer [command.offset] = (char)(0);
		error (1, EINVAL, &quot;[%s]: expecting 0x%02X&quot;, command.buffer, c);
	}
	return;
}

/*====================================================================*
 *
 *--------------------------------------------------------------------*/

#endif


</pre>
		<div class='footerlink'>
			[<a href='sendpacket.c.html' title=' sendpacket.c '>PREV</a>]
			[<a href='toolkit.html' title=' Index '>HOME</a>]
			[<a href='set32bitmap.c.html' title=' set32bitmap.c '>NEXT</a>]
			</div>
		</body>
	</html>