diff --git a/testhal/common/irq_storm.c b/testhal/common/irq_storm.c
new file mode 100644
index 000000000..8d07e3f19
--- /dev/null
+++ b/testhal/common/irq_storm.c
@@ -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;
+  }
+}
+
+/** @} */
diff --git a/testhal/common/irq_storm.h b/testhal/common/irq_storm.h
new file mode 100644
index 000000000..f465fd366
--- /dev/null
+++ b/testhal/common/irq_storm.h
@@ -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_ */
+
+/** @} */