Unified IRQ Storm code.
git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@7882 35acf78f-673a-0410-8e92-d51de3d6d3f4master
Giovanni Di Sirio
parent
e66d398471
commit
5a4986fa34
|
|
@ -0,0 +1,278 @@
|
||||||
|
/*
|
||||||
|
ChibiOS - Copyright (C) 2006..2015 Giovanni Di Sirio
|
||||||
|
|
||||||
|
Licensed under the Apache License, Version 2.0 (the "License");
|
||||||
|
you may not use this file except in compliance with the License.
|
||||||
|
You may obtain a copy of the License at
|
||||||
|
|
||||||
|
http://www.apache.org/licenses/LICENSE-2.0
|
||||||
|
|
||||||
|
Unless required by applicable law or agreed to in writing, software
|
||||||
|
distributed under the License is distributed on an "AS IS" BASIS,
|
||||||
|
WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||||
|
See the License for the specific language governing permissions and
|
||||||
|
limitations under the License.
|
||||||
|
*/
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @file irq_storm.c
|
||||||
|
* @brief IRQ Storm stress test code.
|
||||||
|
*
|
||||||
|
* @addtogroup IRQ_STORM
|
||||||
|
* @{
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "ch.h"
|
||||||
|
#include "hal.h"
|
||||||
|
|
||||||
|
#include "chprintf.h"
|
||||||
|
#include "irq_storm.h"
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Module local definitions. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
#define MSG_SEND_LEFT (msg_t)0
|
||||||
|
#define MSG_SEND_RIGHT (msg_t)1
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Module exported variables. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Module local types. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Module local variables. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
static const irq_storm_config_t *config;
|
||||||
|
|
||||||
|
static bool saturated;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Mailboxes and buffers.
|
||||||
|
*/
|
||||||
|
static mailbox_t mb[IRQ_STORM_CFG_NUM_THREADS];
|
||||||
|
static msg_t b[IRQ_STORM_CFG_NUM_THREADS][IRQ_STORM_CFG_MAILBOX_SIZE];
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Threads working areas.
|
||||||
|
*/
|
||||||
|
static THD_WORKING_AREA(irq_storm_thread_wa[IRQ_STORM_CFG_NUM_THREADS],
|
||||||
|
IRQ_STORM_CFG_STACK_SIZE);
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Pointers to threads.
|
||||||
|
*/
|
||||||
|
static thread_t *threads[IRQ_STORM_CFG_NUM_THREADS];
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Module local functions. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Module exported functions. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Test worker threads.
|
||||||
|
*/
|
||||||
|
static THD_FUNCTION(irq_storm_thread, arg) {
|
||||||
|
static volatile unsigned x = 0;
|
||||||
|
static unsigned cnt = 0;
|
||||||
|
unsigned me = (unsigned)arg;
|
||||||
|
unsigned target;
|
||||||
|
unsigned r;
|
||||||
|
msg_t msg;
|
||||||
|
|
||||||
|
chRegSetThreadName("irq_storm");
|
||||||
|
|
||||||
|
/* Thread loop, until terminated.*/
|
||||||
|
while (chThdShouldTerminateX() == false) {
|
||||||
|
|
||||||
|
/* Waiting for a message.*/
|
||||||
|
chMBFetch(&mb[me], &msg, TIME_INFINITE);
|
||||||
|
|
||||||
|
#if IRQ_STORM_CFG_RANDOMIZE != FALSE
|
||||||
|
/* Pseudo-random delay.*/
|
||||||
|
{
|
||||||
|
chSysLock();
|
||||||
|
r = rand() & 15;
|
||||||
|
chSysUnlock();
|
||||||
|
while (r--)
|
||||||
|
x++;
|
||||||
|
}
|
||||||
|
#else /* IRQ_STORM_CFG_RANDOMIZE == FALSE */
|
||||||
|
/* Fixed delay.*/
|
||||||
|
{
|
||||||
|
r = me >> 4;
|
||||||
|
while (r--)
|
||||||
|
x++;
|
||||||
|
}
|
||||||
|
#endif /* IRQ_STORM_CFG_RANDOMIZE == FALSE */
|
||||||
|
|
||||||
|
/* Deciding in which direction to re-send the message.*/
|
||||||
|
if (msg == MSG_SEND_LEFT)
|
||||||
|
target = me - 1;
|
||||||
|
else
|
||||||
|
target = me + 1;
|
||||||
|
|
||||||
|
if (target < IRQ_STORM_CFG_NUM_THREADS) {
|
||||||
|
/* If this thread is not at the end of a chain re-sending the message,
|
||||||
|
note this check works because the variable target is unsigned.*/
|
||||||
|
msg = chMBPost(&mb[target], msg, TIME_IMMEDIATE);
|
||||||
|
if (msg != MSG_OK)
|
||||||
|
saturated = TRUE;
|
||||||
|
}
|
||||||
|
else {
|
||||||
|
/* Provides a visual feedback about the system.*/
|
||||||
|
if (++cnt >= 500) {
|
||||||
|
cnt = 0;
|
||||||
|
palTogglePad(config->port, config->pad);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief GPT1 callback.
|
||||||
|
*/
|
||||||
|
void irq_storm_gpt1_cb(GPTDriver *gptp) {
|
||||||
|
msg_t msg;
|
||||||
|
|
||||||
|
(void)gptp;
|
||||||
|
chSysLockFromISR();
|
||||||
|
msg = chMBPostI(&mb[0], MSG_SEND_RIGHT);
|
||||||
|
if (msg != MSG_OK)
|
||||||
|
saturated = true;
|
||||||
|
chSysUnlockFromISR();
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief GPT2 callback.
|
||||||
|
*/
|
||||||
|
void irq_storm_gpt2_cb(GPTDriver *gptp) {
|
||||||
|
msg_t msg;
|
||||||
|
|
||||||
|
(void)gptp;
|
||||||
|
chSysLockFromISR();
|
||||||
|
msg = chMBPostI(&mb[IRQ_STORM_CFG_NUM_THREADS - 1], MSG_SEND_LEFT);
|
||||||
|
if (msg != MSG_OK)
|
||||||
|
saturated = true;
|
||||||
|
chSysUnlockFromISR();
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief IRQ storm execution.
|
||||||
|
*
|
||||||
|
* @param[in] cfg pointer to the test configuration structure
|
||||||
|
*
|
||||||
|
* @api
|
||||||
|
*/
|
||||||
|
void irq_storm_execute(const irq_storm_config_t *cfg) {
|
||||||
|
unsigned i;
|
||||||
|
gptcnt_t interval, threshold, worst;
|
||||||
|
|
||||||
|
/* Global configuration pointer.*/
|
||||||
|
config = cfg;
|
||||||
|
|
||||||
|
/* Starting timers using the stored configurations.*/
|
||||||
|
gptStart(cfg->gpt1p, cfg->gptcfg1p);
|
||||||
|
gptStart(cfg->gpt2p, cfg->gptcfg2p);
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Initializes the mailboxes and creates the worker threads.
|
||||||
|
*/
|
||||||
|
for (i = 0; i < IRQ_STORM_CFG_NUM_THREADS; i++) {
|
||||||
|
chMBObjectInit(&mb[i], b[i], IRQ_STORM_CFG_MAILBOX_SIZE);
|
||||||
|
threads[i] = chThdCreateStatic(irq_storm_thread_wa[i],
|
||||||
|
sizeof irq_storm_thread_wa[i],
|
||||||
|
IRQ_STORM_CFG_THREADS_PRIORITY,
|
||||||
|
irq_storm_thread,
|
||||||
|
(void *)i);
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Printing environment information.*/
|
||||||
|
chprintf(cfg->out, "");
|
||||||
|
chprintf(cfg->out, "\r\n*** ChibiOS/RT IRQ-STORM long duration test\r\n***\r\n");
|
||||||
|
chprintf(cfg->out, "*** Kernel: %s\r\n", CH_KERNEL_VERSION);
|
||||||
|
chprintf(cfg->out, "*** Compiled: %s\r\n", __DATE__ " - " __TIME__);
|
||||||
|
#ifdef PORT_COMPILER_NAME
|
||||||
|
chprintf(cfg->out, "*** Compiler: %s\r\n", PORT_COMPILER_NAME);
|
||||||
|
#endif
|
||||||
|
chprintf(cfg->out, "*** Architecture: %s\r\n", PORT_ARCHITECTURE_NAME);
|
||||||
|
#ifdef PORT_CORE_VARIANT_NAME
|
||||||
|
chprintf(cfg->out, "*** Core Variant: %s\r\n", PORT_CORE_VARIANT_NAME);
|
||||||
|
#endif
|
||||||
|
chprintf(cfg->out, "*** System Clock: %d\r\n", cfg->sysclk);
|
||||||
|
#ifdef PORT_INFO
|
||||||
|
chprintf(cfg->out, "*** Port Info: %s\r\n", PORT_INFO);
|
||||||
|
#endif
|
||||||
|
#ifdef PLATFORM_NAME
|
||||||
|
chprintf(cfg->out, "*** Platform: %s\r\n", PLATFORM_NAME);
|
||||||
|
#endif
|
||||||
|
#ifdef BOARD_NAME
|
||||||
|
chprintf(cfg->out, "*** Test Board: %s\r\n", BOARD_NAME);
|
||||||
|
#endif
|
||||||
|
chprintf(cfg->out, "***\r\n");
|
||||||
|
chprintf(cfg->out, "*** Iterations: %d\r\n", IRQ_STORM_CFG_ITERATIONS);
|
||||||
|
chprintf(cfg->out, "*** Randomize: %d\r\n", IRQ_STORM_CFG_RANDOMIZE);
|
||||||
|
chprintf(cfg->out, "*** Threads: %d\r\n", IRQ_STORM_CFG_NUM_THREADS);
|
||||||
|
chprintf(cfg->out, "*** Mailbox size: %d\r\n\r\n", IRQ_STORM_CFG_MAILBOX_SIZE);
|
||||||
|
|
||||||
|
/* Test loop.*/
|
||||||
|
worst = 0;
|
||||||
|
for (i = 1; i <= IRQ_STORM_CFG_ITERATIONS; i++){
|
||||||
|
|
||||||
|
chprintf(cfg->out, "Iteration %d\r\n", i);
|
||||||
|
saturated = false;
|
||||||
|
threshold = 0;
|
||||||
|
|
||||||
|
/* Timer intervals starting at 2mS then decreased by 10% after each
|
||||||
|
cycle.*/
|
||||||
|
for (interval = 2000; interval >= 2; interval -= (interval + 9) / 10) {
|
||||||
|
|
||||||
|
/* Timers programmed slightly out of phase each other.*/
|
||||||
|
gptStartContinuous(cfg->gpt1p, interval - 1); /* Slightly out of phase.*/
|
||||||
|
gptStartContinuous(cfg->gpt2p, interval + 1); /* Slightly out of phase.*/
|
||||||
|
|
||||||
|
/* Storming for one second.*/
|
||||||
|
chThdSleepMilliseconds(1000);
|
||||||
|
|
||||||
|
/* Timers stopped.*/
|
||||||
|
gptStopTimer(cfg->gpt1p);
|
||||||
|
gptStopTimer(cfg->gpt2p);
|
||||||
|
|
||||||
|
/* Did the storm saturate the threads chain?*/
|
||||||
|
if (!saturated)
|
||||||
|
chprintf(cfg->out, ".");
|
||||||
|
else {
|
||||||
|
chprintf(cfg->out, "#");
|
||||||
|
if (threshold == 0)
|
||||||
|
threshold = interval;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/* Gives threads a chance to empty the mailboxes before next cycle.*/
|
||||||
|
chThdSleepMilliseconds(20);
|
||||||
|
chprintf(cfg->out, "\r\nSaturated at %d uS\r\n\r\n", threshold);
|
||||||
|
if (threshold > worst)
|
||||||
|
worst = threshold;
|
||||||
|
}
|
||||||
|
gptStopTimer(&GPTD4);
|
||||||
|
gptStopTimer(&GPTD3);
|
||||||
|
|
||||||
|
chprintf(cfg->out, "Worst case at %d uS\r\n", worst);
|
||||||
|
chprintf(cfg->out, "\r\nTest Complete\r\n");
|
||||||
|
|
||||||
|
/* Terminating threads and cleaning up.*/
|
||||||
|
for (i = 0; i < IRQ_STORM_CFG_NUM_THREADS; i++) {
|
||||||
|
chThdTerminate(threads[i]);
|
||||||
|
chThdWait(threads[i]);
|
||||||
|
threads[i] = NULL;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/** @} */
|
||||||
|
|
@ -0,0 +1,166 @@
|
||||||
|
/*
|
||||||
|
ChibiOS - Copyright (C) 2006..2015 Giovanni Di Sirio
|
||||||
|
|
||||||
|
Licensed under the Apache License, Version 2.0 (the "License");
|
||||||
|
you may not use this file except in compliance with the License.
|
||||||
|
You may obtain a copy of the License at
|
||||||
|
|
||||||
|
http://www.apache.org/licenses/LICENSE-2.0
|
||||||
|
|
||||||
|
Unless required by applicable law or agreed to in writing, software
|
||||||
|
distributed under the License is distributed on an "AS IS" BASIS,
|
||||||
|
WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||||
|
See the License for the specific language governing permissions and
|
||||||
|
limitations under the License.
|
||||||
|
*/
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @file irq_storm.h
|
||||||
|
* @brief IRQ Storm stress test header.
|
||||||
|
*
|
||||||
|
* @addtogroup IRQ_STORM
|
||||||
|
* @{
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef _IRQ_STORM_H_
|
||||||
|
#define _IRQ_STORM_H_
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Module constants. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Module pre-compile time settings. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
#ifndef RANDOMIZE
|
||||||
|
#define RANDOMIZE FALSE
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifndef ITERATIONS
|
||||||
|
#define ITERATIONS 100
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifndef NUM_THREADS
|
||||||
|
#define NUM_THREADS 4
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifndef MAILBOX_SIZE
|
||||||
|
#define MAILBOX_SIZE 4
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @name Configuration options
|
||||||
|
* @{
|
||||||
|
*/
|
||||||
|
/**
|
||||||
|
* @brief Timings randomization.
|
||||||
|
*/
|
||||||
|
#if !defined(IRQ_STORM_CFG_RANDOMIZE) || defined(__DOXYGEN__)
|
||||||
|
#define IRQ_STORM_CFG_RANDOMIZE FALSE
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Number of test iterations.
|
||||||
|
*/
|
||||||
|
#if !defined(IRQ_STORM_CFG_ITERATIONS) || defined(__DOXYGEN__)
|
||||||
|
#define IRQ_STORM_CFG_ITERATIONS 100
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Number of storm threads.
|
||||||
|
*/
|
||||||
|
#if !defined(IRQ_STORM_CFG_NUM_THREADS) || defined(__DOXYGEN__)
|
||||||
|
#define IRQ_STORM_CFG_NUM_THREADS 4
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Priority of storm threads.
|
||||||
|
*/
|
||||||
|
#if !defined(IRQ_STORM_CFG_THREADS_PRIORITY) || defined(__DOXYGEN__)
|
||||||
|
#define IRQ_STORM_CFG_THREADS_PRIORITY (tprio_t)(NORMALPRIO-20)
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Mailboxes size.
|
||||||
|
*/
|
||||||
|
#if !defined(IRQ_STORM_CFG_MAILBOX_SIZE) || defined(__DOXYGEN__)
|
||||||
|
#define IRQ_STORM_CFG_MAILBOX_SIZE 4
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Stack size for worker threads.
|
||||||
|
*/
|
||||||
|
#if !defined(IRQ_STORM_CFG_STACK_SIZE) || defined(__DOXYGEN__)
|
||||||
|
#define IRQ_STORM_CFG_STACK_SIZE 128
|
||||||
|
#endif
|
||||||
|
/** @} */
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Derived constants and error checks. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Module data structures and types. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
/**
|
||||||
|
* @brief Stream for output.
|
||||||
|
*/
|
||||||
|
BaseSequentialStream *out;
|
||||||
|
/**
|
||||||
|
* @brief LED port.
|
||||||
|
*/
|
||||||
|
ioportid_t port;
|
||||||
|
/**
|
||||||
|
* @brief LED bit.
|
||||||
|
*/
|
||||||
|
unsigned pad;
|
||||||
|
/**
|
||||||
|
* @brief GPT driver 1.
|
||||||
|
*/
|
||||||
|
GPTDriver *gpt1p;
|
||||||
|
/**
|
||||||
|
* @brief GPT driver 2.
|
||||||
|
*/
|
||||||
|
GPTDriver *gpt2p;
|
||||||
|
/**
|
||||||
|
* @brief GPT1 configuration 1.
|
||||||
|
*/
|
||||||
|
const GPTConfig *gptcfg1p;
|
||||||
|
/**
|
||||||
|
* @brief GPT1 configuration 2.
|
||||||
|
*/
|
||||||
|
const GPTConfig *gptcfg2p;
|
||||||
|
/**
|
||||||
|
* @brief System clock.
|
||||||
|
*/
|
||||||
|
uint32_t sysclk;
|
||||||
|
} irq_storm_config_t;
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Module macros. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* External declarations. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
extern "C" {
|
||||||
|
#endif
|
||||||
|
void irq_storm_gpt1_cb(GPTDriver *gptp);
|
||||||
|
void irq_storm_gpt2_cb(GPTDriver *gptp);
|
||||||
|
void irq_storm_execute(const irq_storm_config_t *cfg);
|
||||||
|
#ifdef __cplusplus
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/*===========================================================================*/
|
||||||
|
/* Module inline functions. */
|
||||||
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
#endif /* _IRQ_STORM_H_ */
|
||||||
|
|
||||||
|
/** @} */
|
||||||
Loading…
Reference in New Issue