/*
    ChibiOS/RT - Copyright (C) 2006,2007,2008,2009,2010,
                 2011 Giovanni Di Sirio.

    This file is part of ChibiOS/RT.

    ChibiOS/RT 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.

    ChibiOS/RT 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/>.
*/

/**
 * @file    chqueues.c
 * @brief   I/O Queues code.
 *
 * @addtogroup io_queues
 * @details ChibiOS/RT queues are mostly used in serial-like device drivers.
 *          The device drivers are usually designed to have a lower side
 *          (lower driver, it is usually an interrupt service routine) and an
 *          upper side (upper driver, accessed by the application threads).<br>
 *          There are several kind of queues:<br>
 *          - <b>Input queue</b>, unidirectional queue where the writer is the
 *            lower side and the reader is the upper side.
 *          - <b>Output queue</b>, unidirectional queue where the writer is the
 *            upper side and the reader is the lower side.
 *          - <b>Full duplex queue</b>, bidirectional queue. Full duplex queues
 *            are implemented by pairing an input queue and an output queue
 *            together.
 *          .
 *          I/O queues are usually used as an implementation layer for the I/O
 *          channels interface, also see @ref io_channels.
 * @pre     In order to use the I/O queues the @p CH_USE_QUEUES option must
 *          be enabled in @p chconf.h.
 * @{
 */

#include "ch.h"

#if CH_USE_QUEUES || defined(__DOXYGEN__)

/**
 * @brief   Initializes an input queue.
 * @details A Semaphore is internally initialized and works as a counter of
 *          the bytes contained in the queue.
 * @note    The callback is invoked from within the S-Locked system state,
 *          see @ref system_states.
 *
 * @param[out] iqp      pointer to an @p InputQueue structure
 * @param[in] bp        pointer to a memory area allocated as queue buffer
 * @param[in] size      size of the queue buffer
 * @param[in] infy      pointer to a callback function that is invoked when
 *                      data is read from the queue. The value can be @p NULL.
 *
 * @init
 */
void chIQInit(InputQueue *iqp, uint8_t *bp, size_t size, qnotify_t infy) {

  iqp->q_buffer = iqp->q_rdptr = iqp->q_wrptr = bp;
  iqp->q_top = bp + size;
  iqp->q_notify = infy;
  chSemInit(&iqp->q_sem, 0);
}

/**
 * @brief   Returns the filled space into an input queue.
 *
 * @param[in] iqp       pointer to an @p InputQueue structure
 * @return              The number of bytes in the queue.
 * @retval 0            if the queue is empty.
 *
 * @iclass
 */
size_t chIQGetFullI(InputQueue *iqp) {
  cnt_t cnt;

  cnt = chQSpaceI(iqp);
  if (cnt < 0)
    return 0;
  return (size_t)cnt;
}

/**
 * @brief   Resets an input queue.
 * @details All the data in the input queue is erased and lost, any waiting
 *          thread is resumed with status @p Q_RESET.
 * @note    A reset operation can be used by a low level driver in order to
 *          obtain immediate attention from the high level layers.
 *
 * @param[in] iqp       pointer to an @p InputQueue structure
 *
 * @iclass
 */
void chIQResetI(InputQueue *iqp) {

  iqp->q_rdptr = iqp->q_wrptr = iqp->q_buffer;
  chSemResetI(&iqp->q_sem, 0);
}

/**
 * @brief   Input queue write.
 * @details A byte value is written into the low end of an input queue.
 *
 * @param[in] iqp       pointer to an @p InputQueue structure
 * @param[in] b         the byte value to be written in the queue
 * @return              The operation status.
 * @retval Q_OK         if the operation has been completed with success.
 * @retval Q_FULL       if the queue is full and the operation cannot be
 *                      completed.
 *
 * @iclass
 */
msg_t chIQPutI(InputQueue *iqp, uint8_t b) {

  if (chIQIsFullI(iqp))
    return Q_FULL;

  *iqp->q_wrptr++ = b;
  if (iqp->q_wrptr >= iqp->q_top)
    iqp->q_wrptr = iqp->q_buffer;
  chSemSignalI(&iqp->q_sem);
  return Q_OK;
}

/**
 * @brief   Input queue read with timeout.
 * @details This function reads a byte value from an input queue. If the queue
 *          is empty then the calling thread is suspended until a byte arrives
 *          in the queue or a timeout occurs.
 *
 * @param[in] iqp       pointer to an @p InputQueue structure
 * @param[in] time      the number of ticks before the operation timeouts,
 *                      the following special values are allowed:
 *                      - @a TIME_IMMEDIATE immediate timeout.
 *                      - @a TIME_INFINITE no timeout.
 *                      .
 * @return              A byte value from the queue.
 * @retval Q_TIMEOUT    if the specified time expired.
 * @retval Q_RESET      if the queue<style>pre { line-height: 125%; margin: 0; }
td.linenos pre { color: #000000; background-color: #f0f0f0; padding: 0 5px 0 5px; }
span.linenos { color: #000000; background-color: #f0f0f0; padding: 0 5px 0 5px; }
td.linenos pre.special { color: #000000; background-color: #ffffc0; padding: 0 5px 0 5px; }
span.linenos.special { color: #000000; background-color: #ffffc0; padding: 0 5px 0 5px; }
.highlight .hll { background-color: #ffffcc }
.highlight { background: #ffffff; }
.highlight .c { color: #888888 } /* Comment */
.highlight .err { color: #a61717; background-color: #e3d2d2 } /* Error */
.highlight .k { color: #008800; font-weight: bold } /* Keyword */
.highlight .ch { color: #888888 } /* Comment.Hashbang */
.highlight .cm { color: #888888 } /* Comment.Multiline */
.highlight .cp { color: #cc0000; font-weight: bold } /* Comment.Preproc */
.highlight .cpf { color: #888888 } /* Comment.PreprocFile */
.highlight .c1 { color: #888888 } /* Comment.Single */
.highlight .cs { color: #cc0000; font-weight: bold; background-color: #fff0f0 } /* Comment.Special */
.highlight .gd { color: #000000; background-color: #ffdddd } /* Generic.Deleted */
.highlight .ge { font-style: italic } /* Generic.Emph */
.highlight .gr { color: #aa0000 } /* Generic.Error */
.highlight .gh { color: #333333 } /* Generic.Heading */
.highlight .gi { color: #000000; background-color: #ddffdd } /* Generic.Inserted */
.highlight .go { color: #888888 } /* Generic.Output */
.highlight .gp { color: #555555 } /* Generic.Prompt */
.highlight .gs { font-weight: bold } /* Generic.Strong */
.highlight .gu { color: #666666 } /* Generic.Subheading */
.highlight .gt { color: #aa0000 } /* Generic.Traceback */
.highlight .kc { color: #008800; font-weight: bold } /* Keyword.Constant */
.highlight .kd { color: #008800; font-weight: bold } /* Keyword.Declaration */
.highlight .kn { color: #008800; font-weight: bold } /* Keyword.Namespace */
.highlight .kp { color: #008800 } /* Keyword.Pseudo */
.highlight .kr { color: #008800; font-weight: bold } /* Keyword.Reserved */
.highlight .kt { color: #888888; font-weight: bold } /* Keyword.Type */
.highlight .m { color: #0000DD; font-weight: bold } /* Literal.Number */
.highlight .s { color: #dd2200; background-color: #fff0f0 } /* Literal.String */
.highlight .na { color: #336699 } /* Name.Attribute */
.highlight .nb { color: #003388 } /* Name.Builtin */
.highlight .nc { color: #bb0066; font-weight: bold } /* Name.Class */
.highlight .no { color: #003366; font-weight: bold } /* Name.Constant */
.highlight .nd { color: #555555 } /* Name.Decorator */
.highlight .ne { color: #bb0066; font-weight: bold } /* Name.Exception */
.highlight .nf { color: #0066bb; font-weight: bold } /* Name.Function */
.highlight .nl { color: #336699; font-style: italic } /* Name.Label */
.highlight .nn { color: #bb0066; font-weight: bold } /* Name.Namespace */
.highlight .py { color: #336699; font-weight: bold } /* Name.Property */
.highlight .nt { color: #bb0066; font-weight: bold } /* Name.Tag */
.highlight .nv { color: #336699 } /* Name.Variable */
.highlight .ow { color: #008800 } /* Operator.Word */
.highlight .w { color: #bbbbbb } /* Text.Whitespace */
.highlight .mb { color: #0000DD; font-weight: bold } /* Literal.Number.Bin */
.highlight .mf { color: #0000DD; font-weight: bold } /* Literal.Number.Float */
.highlight .mh { color: #0000DD; font-weight: bold } /* Literal.Number.Hex */
.highlight .mi { color: #0000DD; font-weight: bold } /* Literal.Number.Integer */
.highlight .mo { color: #0000DD; font-weight: bold } /* Literal.Number.Oct */
.highlight .sa { color: #dd2200; background-color: #fff0f0 } /* Literal.String.Affix */
.highlight .sb { color: #dd2200; background-color: #fff0f0 } /* Literal.String.Backtick */
.highlight .sc { color: #dd2200; background-color: #fff0f0 } /* Literal.String.Char */
.highlight .dl { color: #dd2200; background-color: #fff0f0 } /* Literal.String.Delimiter */
.highlight .sd { color: #dd2200; background-color: #fff0f0 } /* Literal.String.Doc */
.highlight .s2 { color: #dd2200; background-color: #fff0f0 } /* Literal.String.Double */
.highlight .se { color: #0044dd; background-color: #fff0f0 } /* Literal.String.Escape */
.highlight .sh { color: #dd2200; background-color: #fff0f0 } /* Literal.String.Heredoc */
.highlight .si { color: #3333bb; background-color: #fff0f0 } /* Literal.String.Interpol */
.highlight .sx { color: #22bb22; background-color: #f0fff0 } /* Literal.String.Other */
.highlight .sr { color: #008800; background-color: #fff0ff } /* Literal.String.Regex */
.highlight .s1 { color: #dd2200; background-color: #fff0f0 } /* Literal.String.Single */
.highlight .ss { color: #aa6600; background-color: #fff0f0 } /* Literal.String.Symbol */
.highlight .bp { color: #003388 } /* Name.Builtin.Pseudo */
.highlight .fm { color: #0066bb; font-weight: bold } /* Name.Function.Magic */
.highlight .vc { color: #336699 } /* Name.Variable.Class */
.highlight .vg { color: #dd7700 } /* Name.Variable.Global */
.highlight .vi { color: #3333bb } /* Name.Variable.Instance */
.highlight .vm { color: #336699 } /* Name.Variable.Magic */
.highlight .il { color: #0000DD; font-weight: bold } /* Literal.Number.Integer.Long */</style><div class="highlight"><pre><span></span><span class="ch">#! /bin/sh</span>
<span class="c1"># A little script I whipped up to make it easy to</span>
<span class="c1"># patch source trees and have sane error handling</span>
<span class="c1"># -Erik</span>
<span class="c1">#</span>
<span class="c1"># (c) 2002 Erik Andersen &lt;andersen@codepoet.org&gt;</span>

<span class="c1"># Set directories from arguments, or use defaults.</span>
<span class="nv">targetdir</span><span class="o">=</span><span class="si">${</span><span class="nv">1</span><span class="p">-.</span><span class="si">}</span>
<span class="nv">patchdir</span><span class="o">=</span><span class="si">${</span><span class="nv">2</span><span class="p">-../kernel-patches</span><span class="si">}</span>
<span class="nv">patchpattern</span><span class="o">=</span><span class="si">${</span><span class="nv">3</span><span class="p">-*</span><span class="si">}</span>

<span class="k">if</span> <span class="o">[</span> ! -d <span class="s2">&quot;</span><span class="si">${</span><span class="nv">targetdir</span><span class="si">}</span><span class="s2">&quot;</span> <span class="o">]</span> <span class="p">;</span> <span class="k">then</span>
    <span class="nb">echo</span> <span class="s2">&quot;Aborting.  &#39;</span><span class="si">${</span><span class="nv">targetdir</span><span class="si">}</span><span class="s2">&#39; is not a directory.&quot;</span>
    <span class="nb">exit</span> <span class="m">1</span>
<span class="k">fi</span>
<span class="k">if</span> <span class="o">[</span> ! -d <span class="s2">&quot;</span><span class="si">${</span><span class="nv">patchdir</span><span class="si">}</span><span class="s2">&quot;</span> <span class="o">]</span> <span class="p">;</span> <span class="k">then</span>
    <span class="nb">echo</span> <span class="s2">&quot;Aborting.  &#39;</span><span class="si">${</span><span class="nv">patchdir</span><span class="si">}</span><span class="s2">&#39; is not a directory.&quot;</span>
    <span class="nb">exit</span> <span class="m">1</span>
<span class="k">fi</span>
    
<span class="k">for</span> i in <span class="si">${</span><span class="nv">patchdir</span><span class="si">}</span>/<span class="si">${</span><span class="nv">patchpattern</span><span class="si">}</span> <span class="p">;</span> <span class="k">do</span> 
    <span class="k">case</span> <span class="s2">&quot;</span><span class="nv">$i</span><span class="s2">&quot;</span> in
	*.gz<span class="o">)</span>
	<span class="nv">type</span><span class="o">=</span><span class="s2">&quot;gzip&quot;</span><span class="p">;</span> <span class="nv">uncomp</span><span class="o">=</span><span class="s2">&quot;gunzip -dc&quot;</span><span class="p">;</span> <span class="p">;;</span> 
	*.bz<span class="o">)</span>
	<span class="nv">type</span><span class="o">=</span><span class="s2">&quot;bzip&quot;</span><span class="p">;</span> <span class="nv">uncomp</span><span class="o">=</span><span class="s2">&quot;bunzip -dc&quot;</span><span class="p">;</span> <span class="p">;;</span> 
	*.bz2<span class="o">)</span>
	<span class="nv">type</span><span class="o">=</span><span class="s2">&quot;bzip2&quot;</span><span class="p">;</span> <span class="nv">uncomp</span><span class="o">=</span><span class="s2">&quot;bunzip2 -dc&quot;</span><span class="p">;</span> <span class="p">;;</span> 
	*.zip<span class="o">)</span>
	<span class="nv">type</span><span class="o">=</span><span class="s2">&quot;zip&quot;</span><span class="p">;</span> <span class="nv">uncomp</span><span class="o">=</span><span class="s2">&quot;unzip -d&quot;</span><span class="p">;</span> <span class="p">;;</span> 
	*.Z<span class="o">)</span>
	<span class="nv">type</span><span class="o">=</span><span class="s2">&quot;compress&quot;</span><span class="p">;</span> <span class="nv">uncomp</span><span class="o">=</span><span class="s2">&quot;uncompress -c&quot;</span><span class="p">;</span> <span class="p">;;</span> 
	*<span class="o">)</span>
	<span class="nv">type</span><span class="o">=</span><span class="s2">&quot;plaintext&quot;</span><span class="p">;</span> <span class="nv">uncomp</span><span class="o">=</span><span class="s2">&quot;cat&quot;</span><span class="p">;</span> <span class="p">;;</span> 
    <span class="k">esac</span>
    <span class="o">[</span> -d <span class="s2">&quot;</span><span class="si">${</span><span class="nv">i</span><span class="si">}</span><span class="s2">&quot;</span> <span class="o">]</span> <span class="o">&amp;&amp;</span> <span class="nb">echo</span> <span class="s2">&quot;Ignoring subdirectory </span><span class="si">${</span><span class="nv">i</span><span class="si">}</span><span class="s2">&quot;</span> <span class="o">&amp;&amp;</span> <span class="k">continue</span>	
    <span class="nb">echo</span> <span class="s2">&quot;&quot;</span>
    <span class="nb">echo</span> <span class="s2">&quot;Applying </span><span class="si">${</span><span class="nv">i</span><span class="si">}</span><span class="s2"> using </span><span class="si">${</span><span class="nv">type</span><span class="si">}</span><span class="s2">: &quot;</span> 
    <span class="si">${</span><span class="nv">uncomp</span><span class="si">}</span> <span class="si">${</span><span class="nv">i</span><span class="si">}</span> <span class="p">|</span> <span class="si">${</span><span class="nv">PATCH</span><span class="k">:-</span><span class="nv">patch</span><span class="si">}</span> -f -p1 -E -d <span class="si">${</span><span class="nv">targetdir</span><span class="si">}</span> 
    <span class="k">if</span> <span class="o">[</span> <span class="nv">$?</span> !<span class="o">=</span> <span class="m">0</span> <span class="o">]</span> <span class="p">;</span> <span class="k">then</span>
        <span class="nb">echo</span> <span class="s2">&quot;Patch failed!  Please fix </span><span class="nv">$i</span><span class="s2">!&quot;</span>
	<span class="nb">exit</span> <span class="m">1</span>
    <span class="k">fi</span>
<span class="k">done</span>

<span class="c1"># Check for rejects...</span>
<span class="k">if</span> <span class="o">[</span> <span class="s2">&quot;`find </span><span class="nv">$targetdir</span><span class="s2">/ &#39;(&#39; -name &#39;*.rej&#39; -o -name &#39;.*.rej&#39; &#39;)&#39; -print`&quot;</span> <span class="o">]</span> <span class="p">;</span> <span class="k">then</span>
    <span class="nb">echo</span> <span class="s2">&quot;Aborting.  Reject files found.&quot;</span>
    <span class="nb">exit</span> <span class="m">1</span>
<span class="k">fi</span>

<span class="c1"># Remove backup files</span>
find <span class="nv">$targetdir</span>/ <span class="s1">&#39;(&#39;</span> -name <span class="s1">&#39;*.orig&#39;</span> -o -name <span class="s1">&#39;.*.orig&#39;</span> <span class="s1">&#39;)&#39;</span> -exec rm -f <span class="o">{}</span> <span class="se">\;</span>
</pre></div>
</code></pre></td></tr></table>
</div> <!-- class=content -->
<div class='footer'>generated by <a href='https://git.zx2c4.com/cgit/about/'>cgit v1.2.3</a> (<a href='https://git-scm.com/'>git 2.25.1</a>) at 2025-03-12 04:45:51 +0000</div>
</div> <!-- id=cgit -->
</body>
</html>