nuttx/sched/wdog/wd_cancel.c

171 lines
5.4 KiB
C
Raw Normal View History

/****************************************************************************
* sched/wdog/wd_cancel.c
*
2014-08-07 19:39:16 +02:00
* Copyright (C) 2007-2009, 2014 Gregory Nutt. All rights reserved.
* Author: Gregory Nutt <gnutt@nuttx.org>
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
*
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. 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.
* 3. Neither the name NuttX nor the names of its contributors may be
* used to endorse or promote products derived from this software
* without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
* "AS IS" 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.
*
****************************************************************************/
/****************************************************************************
* Included Files
****************************************************************************/
#include <nuttx/config.h>
#include <stdbool.h>
#include <assert.h>
#include <wdog.h>
#include <nuttx/arch.h>
#include "sched/sched.h"
#include "wdog/wdog.h"
/****************************************************************************
* Pre-processor Definitions
****************************************************************************/
/****************************************************************************
* Private Type Declarations
****************************************************************************/
/****************************************************************************
* Global Variables
****************************************************************************/
/****************************************************************************
* Private Variables
****************************************************************************/
/****************************************************************************
* Private Functions
****************************************************************************/
/****************************************************************************
* Public Functions
****************************************************************************/
/****************************************************************************
* Name: wd_cancel
*
* Description:
* This function cancels a currently running watchdog timer. Watchdog
2014-08-07 19:39:16 +02:00
* timers may be cancelled from the interrupt level.
*
* Parameters:
* wdid - ID of the watchdog to cancel.
*
* Return Value:
* OK or ERROR
*
* Assumptions:
*
****************************************************************************/
2014-08-07 19:39:16 +02:00
int wd_cancel(WDOG_ID wdid)
{
wdog_t *curr;
wdog_t *prev;
irqstate_t saved_state;
int ret = ERROR;
/* Prohibit timer interactions with the timer queue until the
* cancellation is complete
*/
saved_state = irqsave();
2014-08-07 19:39:16 +02:00
/* Make sure that the watchdog is initialized (non-NULL) and is still active */
if (wdid && wdid->active)
{
/* Search the g_wdactivelist for the target FCB. We can't use sq_rem
* to do this because there are additional operations that need to be
* done.
*/
prev = NULL;
curr = (wdog_t*)g_wdactivelist.head;
while ((curr) && (curr != wdid))
{
prev = curr;
curr = curr->next;
}
/* Check if the watchdog was found in the list. If not, then an OS
* error has occurred because the watchdog is marked active!
*/
2013-04-25 23:19:59 +02:00
ASSERT(curr);
/* If there is a watchdog in the timer queue after the one that
2014-08-07 19:39:16 +02:00
* is being cancelled, then it inherits the remaining ticks.
2013-04-25 23:19:59 +02:00
*/
if (curr->next)
{
curr->next->lag += curr->lag;
}
/* Now, remove the watchdog from the timer queue */
if (prev)
{
2014-08-07 19:39:16 +02:00
/* Remove the watchdog from mid- or end-of-queue */
2013-04-25 23:19:59 +02:00
(void)sq_remafter((FAR sq_entry_t*)prev, &g_wdactivelist);
}
else
{
2014-08-07 19:39:16 +02:00
/* Remove the watchdog at the head of the queue */
2014-08-07 19:39:16 +02:00
(void)sq_remfirst(&g_wdactivelist);
2013-04-25 23:19:59 +02:00
2014-08-07 19:39:16 +02:00
/* Reassess the interval timer that will generate the next
* interval event.
*/
2013-04-25 23:19:59 +02:00
2014-08-07 19:39:16 +02:00
sched_timer_reassess();
}
2013-04-25 23:19:59 +02:00
/* Mark the watchdog inactive */
2014-08-07 19:39:16 +02:00
wdid->next = NULL;
wdid->active = false;
2014-08-07 19:39:16 +02:00
/* Return success */
ret = OK;
}
irqrestore(saved_state);
return ret;
}