git-svn-id: svn://svn.code.sf.net/p/chibios/svn/branches/kernel_3_dev@6225 35acf78f-673a-0410-8e92-d51de3d6d3f4

2 files changed, 10 insertions, 14 deletions

diff --git a/os/hal/platforms/STM32/USBv1/usb_lld.c b/os/hal/platforms/STM32/USBv1/usb_lld.c
index bdf202a81..6f1dbc099 100644
--- a/os/hal/platforms/STM32/USBv1/usb_lld.c
+++ b/os/hal/platforms/STM32/USBv1/usb_lld.c
@@ -24,7 +24,6 @@
 

 #include <string.h>

 

-#include "ch.h"

 #include "hal.h"

 

 #if HAL_USE_USB || defined(__DOXYGEN__)

@@ -177,9 +176,10 @@ static void usb_packet_read_to_queue(stm32_usb_descriptor_t *udp,
 

   /* Updating queue.*/

   osalSysLockFromISR();

+

   iqp->q_counter += n;

-  while (queue_notempty(&iqp->q_waiting))

-    chSchReadyI(queue_fifo_remove(&iqp->q_waiting))->p_u.rdymsg = Q_OK;

+  osalQueueWakeupAllI(&iqp->q_waiting, Q_OK);

+

   osalSysUnlockFromISR();

 }

 

@@ -222,6 +222,7 @@ static void usb_packet_write_from_buffer(stm32_usb_descriptor_t *udp,
 static void usb_packet_write_from_queue(stm32_usb_descriptor_t *udp,

                                         output_queue_t *oqp, size_t n) {

   size_t nhw;

+  syssts_t sts;

   uint32_t *pmap = USB_ADDR2PTR(udp->TXADDR0);

 

   udp->TXCOUNT0 = (uint16_t)n;

@@ -246,18 +247,13 @@ static void usb_packet_write_from_queue(stm32_usb_descriptor_t *udp,
       oqp->q_rdptr = oqp->q_buffer;

   }

 

-  /* Updating queue. Note, the lock is done in this unusual way because this

-     function can be called from both ISR and thread context so the kind

-     of lock function to be invoked cannot be decided beforehand.*/

-  port_lock();

-  _dbg_enter_lock();

+  /* Updating queue.*/

+  sts = osalSysGetAndLockX();

 

   oqp->q_counter += n;

-  while (queue_notempty(&oqp->q_waiting))

-    chSchReadyI(queue_fifo_remove(&oqp->q_waiting))->p_u.rdymsg = Q_OK;

+  osalQueueWakeupAllI(&oqp->q_waiting, Q_OK);

 

-  _dbg_leave_lock();

-  port_unlock();

+  osalSysRestoreLockX(sts);

 }

 

 /*===========================================================================*/

diff --git a/os/hal/platforms/STM32/USBv1/usb_lld.h b/os/hal/platforms/STM32/USBv1/usb_lld.h
index aae229754..042129758 100644
--- a/os/hal/platforms/STM32/USBv1/usb_lld.h
+++ b/os/hal/platforms/STM32/USBv1/usb_lld.h
@@ -114,7 +114,7 @@ typedef struct {
   /**

    * @brief   Buffer mode, queue or linear.

    */

-  bool_t                        txqueued;

+  bool                          txqueued;

   /**

    * @brief   Requested transmit transfer size.

    */

@@ -147,7 +147,7 @@ typedef struct {
   /**

    * @brief   Buffer mode, queue or linear.

    */

-  bool_t                        rxqueued;

+  bool                          rxqueued;

   /**

    * @brief   Requested receive transfer size.

    */