From a82b55b37f97bd4e98c646de74887a4372b14d7a Mon Sep 17 00:00:00 2001
From: patacongo <patacongo@42af7a65-404d-4744-a932-0658087f49c3>
Date: Wed, 11 Jan 2012 00:13:45 +0000
Subject: [PATCH] Implement the new CAN txready method for STM32

git-svn-id: svn://svn.code.sf.net/p/nuttx/code/trunk@4291 42af7a65-404d-4744-a932-0658087f49c3
---
 arch/arm/src/lpc17xx/lpc17_can.c |  4 +--
 arch/arm/src/stm32/stm32_can.c   | 45 ++++++++++++++++++++++++++++++--
 2 files changed, 45 insertions(+), 4 deletions(-)

diff --git a/arch/arm/src/lpc17xx/lpc17_can.c b/arch/arm/src/lpc17xx/lpc17_can.c
index 3539ce4afc..1aee04508c 100755
--- a/arch/arm/src/lpc17xx/lpc17_can.c
+++ b/arch/arm/src/lpc17xx/lpc17_can.c
@@ -849,7 +849,7 @@ static int can_send(FAR struct can_dev_s *dev, FAR struct can_msg_s *msg)
  *   dev - An instance of the "upper half" can driver state structure.
  *
  * Returned Value:
- *   True is the CAN hardware is ready to accept another TX message.
+ *   True if the CAN hardware is ready to accept another TX message.
  *
  ****************************************************************************/
 
@@ -874,7 +874,7 @@ static bool can_txready(FAR struct can_dev_s *dev)
  *   dev - An instance of the "upper half" can driver state structure.
  *
  * Returned Value:
- *   True is there are no pending TX transfers in the CAN hardware.
+ *   True if there are no pending TX transfers in the CAN hardware.
  *
  ****************************************************************************/
 
diff --git a/arch/arm/src/stm32/stm32_can.c b/arch/arm/src/stm32/stm32_can.c
index 08f932b377..bf83773a97 100755
--- a/arch/arm/src/stm32/stm32_can.c
+++ b/arch/arm/src/stm32/stm32_can.c
@@ -130,6 +130,7 @@ static void can_txint(FAR struct can_dev_s *dev, bool enable);
 static int  can_ioctl(FAR struct can_dev_s *dev, int cmd, unsigned long arg);
 static int  can_remoterequest(FAR struct can_dev_s *dev, uint16_t id);
 static int  can_send(FAR struct can_dev_s *dev, FAR struct can_msg_s *msg);
+static bool can_txready(FAR struct can_dev_s *dev);
 static bool can_txempty(FAR struct can_dev_s *dev);
 
 /* CAN interrupt handling */
@@ -156,6 +157,7 @@ static const struct can_ops_s g_canops =
   .co_ioctl         = can_ioctl,
   .co_remoterequest = can_remoterequest,
   .co_send          = can_send,
+  .co_txready       = can_txready,
   .co_txempty       = can_txempty,
 };
 
@@ -868,6 +870,45 @@ static int can_send(FAR struct can_dev_s *dev, FAR struct can_msg_s *msg)
   return OK;
 }
 
+/****************************************************************************
+ * Name: can_txready
+ *
+ * Description:
+ *   Return true if the CAN hardware can accept another TX message.
+ *
+ * Input Parameters:
+ *   dev - An instance of the "upper half" can driver state structure.
+ *
+ * Returned Value:
+ *   True if the CAN hardware is ready to accept another TX message.
+ *
+ ****************************************************************************/
+
+static bool can_txready(FAR struct can_dev_s *dev)
+{
+  FAR struct stm32_can_s *priv = dev->cd_priv;
+  uint32_t regval;
+
+  /* Return true if any mailbox is available */
+
+  regval = can_getreg(priv, STM32_CAN_TSR_OFFSET);
+  canllvdbg("CAN%d TSR: %08x\n", priv->port, regval);
+
+  if ((regval & CAN_TSR_TME0) != 0)
+    {
+      return true;
+    }
+  else if ((regval & CAN_TSR_TME1) != 0)
+    {
+      return true;
+    }
+  else if ((regval & CAN_TSR_TME2) != 0)
+    {
+      return true;
+    }
+  return false;
+}
+
 /****************************************************************************
  * Name: can_txempty
  *
@@ -882,7 +923,7 @@ static int can_send(FAR struct can_dev_s *dev, FAR struct can_msg_s *msg)
  *   dev - An instance of the "upper half" can driver state structure.
  *
  * Returned Value:
- *   Zero on success; a negated errno on failure
+ *   True if there are no pending TX transfers in the CAN hardware.
  *
  ****************************************************************************/
 
@@ -1240,7 +1281,7 @@ static int can_cellinit(struct stm32_can_s *priv)
   regval &= ~CAN_MCR_INRQ;
   can_putreg(priv, STM32_CAN_MCR_OFFSET, regval);
 
-  /* Wait until initialization mode is acknowledged */
+  /* Wait until the initialization mode exit is acknowledged */
 
   for (timeout = INAK_TIMEOUT; timeout > 0; timeout--)
     {