summaryrefslogtreecommitdiff
path: root/components/drivers/can
diff options
context:
space:
mode:
authorBernardXiong <[email protected]>2015-07-06 18:11:46 +0800
committerBernardXiong <[email protected]>2015-07-06 18:11:46 +0800
commit91d866d81a20e014b25365391ee1dda0f544fd01 (patch)
tree3e76f950f94da371b3f2f664267a0c169bb54553 /components/drivers/can
parent1488568801ac099d678d39e71c508543dd13ee17 (diff)
[DeviceDrivers] Use mutex to lock can_open/close
Diffstat (limited to 'components/drivers/can')
-rw-r--r--components/drivers/can/can.c278
1 files changed, 82 insertions, 196 deletions
diff --git a/components/drivers/can/can.c b/components/drivers/can/can.c
index 4cc02818c6..e0db377018 100644
--- a/components/drivers/can/can.c
+++ b/components/drivers/can/can.c
@@ -3,20 +3,33 @@
* This file is part of RT-Thread RTOS
* COPYRIGHT (C) 2015, RT-Thread Development Team
*
- * The license and distribution terms for this file may be
- * found in the file LICENSE in this distribution or at
- * http://www.rt-thread.org/license/LICENSE
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, write to the Free Software Foundation, Inc.,
+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
*
* Change Logs:
* Date Author Notes
* 2015-05-14 [email protected] first version
- * 2015-07-06 Bernard code cleanup.
+ * 2015-07-06 Bernard code cleanup and remove RT_CAN_USING_LED;
*/
#include <rthw.h>
#include <rtthread.h>
#include <rtdevice.h>
+#define CAN_LOCK(can) rt_mutex_take(&(can->lock), RT_WAITING_FOREVER)
+#define CAN_UNLOCK(can) rt_mutex_release(&(can->lock))
+
static rt_err_t rt_can_init(struct rt_device *dev)
{
rt_err_t result = RT_EOK;
@@ -54,7 +67,6 @@ rt_inline int _can_int_rx(struct rt_can_device *can, struct rt_can_msg *data, in
while (msgs)
{
rt_base_t level;
- rt_int32_t hdr;
struct rt_can_msg_list *listmsg = RT_NULL;
/* disable interrupt */
@@ -75,6 +87,7 @@ rt_inline int _can_int_rx(struct rt_can_device *can, struct rt_can_msg *data, in
}
else if (hdr == -1)
#endif /*RT_CAN_USING_HDR*/
+ {
if (!rt_list_isempty(&rx_fifo->uselist))
{
listmsg = rt_list_entry(rx_fifo->uselist.next, struct rt_can_msg_list, list);
@@ -86,7 +99,7 @@ rt_inline int _can_int_rx(struct rt_can_device *can, struct rt_can_msg *data, in
listmsg->owner->msgs--;
}
listmsg->owner = RT_NULL;
-#endif
+#endif /*RT_CAN_USING_HDR*/
}
else
{
@@ -94,17 +107,20 @@ rt_inline int _can_int_rx(struct rt_can_device *can, struct rt_can_msg *data, in
rt_hw_interrupt_enable(level);
break;
}
+ }
/* enable interrupt */
rt_hw_interrupt_enable(level);
if (listmsg != RT_NULL)
{
rt_memcpy(data, &listmsg->data, sizeof(struct rt_can_msg));
+
level = rt_hw_interrupt_disable();
rt_list_insert_before(&rx_fifo->freelist, &listmsg->list);
rx_fifo->freenumbers++;
RT_ASSERT(rx_fifo->freenumbers <= can->config.msgboxsz);
rt_hw_interrupt_enable(level);
+
listmsg = RT_NULL;
}
else
@@ -146,20 +162,23 @@ rt_inline int _can_int_tx(struct rt_can_device *can, const struct rt_can_msg *da
else
{
rt_hw_interrupt_enable(level);
+
rt_completion_wait(&(tx_fifo->completion), RT_WAITING_FOREVER);
continue;
}
rt_hw_interrupt_enable(level);
no = ((rt_uint32_t)tx_tosnd - (rt_uint32_t)tx_fifo->buffer) / sizeof(struct rt_can_sndbxinx_list);
- tx_tosnd->result = RT_CAN__SND_RESUTL_WAIT;
- if (can->ops->sendmsg(can, data , no))
+ tx_tosnd->result = RT_CAN_SND_RESULT_WAIT;
+ if (can->ops->sendmsg(can, data, no) != RT_EOK)
{
+ /* send failed. */
level = rt_hw_interrupt_disable();
rt_list_insert_after(&tx_fifo->freelist, &tx_tosnd->list);
rt_hw_interrupt_enable(level);
continue;
}
+
can->status.sndchange = 1;
rt_completion_wait(&(tx_tosnd->completion), RT_WAITING_FOREVER);
@@ -172,11 +191,12 @@ rt_inline int _can_int_tx(struct rt_can_device *can, const struct rt_can_msg *da
rt_list_insert_before(&tx_fifo->freelist, &tx_tosnd->list);
rt_hw_interrupt_enable(level);
- if (result == RT_CAN__SND_RESUTL_OK)
+ if (result == RT_CAN_SND_RESULT_OK)
{
level = rt_hw_interrupt_disable();
can->status.sndpkg++;
rt_hw_interrupt_enable(level);
+
data ++;
msgs -= sizeof(struct rt_can_msg);
if (!msgs) break;
@@ -192,13 +212,9 @@ rt_inline int _can_int_tx(struct rt_can_device *can, const struct rt_can_msg *da
level = rt_hw_interrupt_disable();
if (rt_list_isempty(&tx_fifo->freelist))
{
- rt_hw_interrupt_enable(level);
rt_completion_done(&(tx_fifo->completion));
}
- else
- {
- rt_hw_interrupt_enable(level);
- }
+ rt_hw_interrupt_enable(level);
}
return (size - msgs);
@@ -226,16 +242,17 @@ rt_inline int _can_int_tx_priv(struct rt_can_device *can, const struct rt_can_ms
}
level = rt_hw_interrupt_disable();
- if ((tx_fifo->buffer[no].result != RT_CAN__SND_RESUTL_OK))
+ if ((tx_fifo->buffer[no].result != RT_CAN_SND_RESULT_OK))
{
rt_hw_interrupt_enable(level);
+
rt_completion_wait(&(tx_fifo->buffer[no].completion), RT_WAITING_FOREVER);
continue;
}
- tx_fifo->buffer[no].result = RT_CAN__SND_RESUTL_WAIT;
+ tx_fifo->buffer[no].result = RT_CAN_SND_RESULT_WAIT;
rt_hw_interrupt_enable(level);
- if (can->ops->sendmsg(can, data , no) != RT_EOK)
+ if (can->ops->sendmsg(can, data, no) != RT_EOK)
{
continue;
}
@@ -243,7 +260,7 @@ rt_inline int _can_int_tx_priv(struct rt_can_device *can, const struct rt_can_ms
rt_completion_wait(&(tx_fifo->buffer[no].completion), RT_WAITING_FOREVER);
result = tx_fifo->buffer[no].result;
- if (result == RT_CAN__SND_RESUTL_OK)
+ if (result == RT_CAN_SND_RESULT_OK)
{
level = rt_hw_interrupt_disable();
can->status.sndpkg++;
@@ -271,19 +288,21 @@ static rt_err_t rt_can_open(struct rt_device *dev, rt_uint16_t oflag)
RT_ASSERT(dev != RT_NULL);
can = (struct rt_can_device *)dev;
+ CAN_LOCK(can);
+
/* get open flags */
dev->open_flag = oflag & 0xff;
- rt_enter_critical();
if (can->can_rx == RT_NULL)
{
if (oflag & RT_DEVICE_FLAG_INT_RX)
{
- int i=0;
+ int i = 0;
struct rt_can_rx_fifo *rx_fifo;
rx_fifo = (struct rt_can_rx_fifo *) rt_malloc(sizeof(struct rt_can_rx_fifo) +
can->config.msgboxsz * sizeof(struct rt_can_msg_list));
RT_ASSERT(rx_fifo != RT_NULL);
+
rx_fifo->buffer = (struct rt_can_msg_list *)(rx_fifo + 1);
rt_memset(rx_fifo->buffer, 0, can->config.msgboxsz * sizeof(struct rt_can_msg_list));
rt_list_init(&rx_fifo->freelist);
@@ -298,7 +317,6 @@ static rt_err_t rt_can_open(struct rt_device *dev, rt_uint16_t oflag)
#endif
}
can->can_rx = rx_fifo;
- rt_exit_critical();
dev->open_flag |= RT_DEVICE_FLAG_INT_RX;
/* configure low level device */
@@ -307,15 +325,9 @@ static rt_err_t rt_can_open(struct rt_device *dev, rt_uint16_t oflag)
else
{
can->can_rx = RT_NULL;
- rt_exit_critical();
}
}
- else
- {
- rt_exit_critical();
- }
- rt_enter_critical();
if (can->can_tx == RT_NULL)
{
if (oflag & RT_DEVICE_FLAG_INT_TX)
@@ -326,6 +338,7 @@ static rt_err_t rt_can_open(struct rt_device *dev, rt_uint16_t oflag)
tx_fifo = (struct rt_can_tx_fifo *) rt_malloc(sizeof(struct rt_can_tx_fifo) +
can->config.sndboxnumber * sizeof(struct rt_can_sndbxinx_list));
RT_ASSERT(tx_fifo != RT_NULL);
+
tx_fifo->buffer = (struct rt_can_sndbxinx_list *)(tx_fifo + 1);
rt_memset(tx_fifo->buffer, 0,
can->config.sndboxnumber * sizeof(struct rt_can_sndbxinx_list));
@@ -334,11 +347,11 @@ static rt_err_t rt_can_open(struct rt_device *dev, rt_uint16_t oflag)
{
rt_list_insert_before(&tx_fifo->freelist, &tx_fifo->buffer[i].list);
rt_completion_init(&(tx_fifo->buffer[i].completion));
- tx_fifo->buffer[i].result = RT_CAN__SND_RESUTL_OK;
+ tx_fifo->buffer[i].result = RT_CAN_SND_RESULT_OK;
}
rt_completion_init(&(tx_fifo->completion));
can->can_tx = tx_fifo;
- rt_exit_critical();
+
dev->open_flag |= RT_DEVICE_FLAG_INT_TX;
/* configure low level device */
can->ops->control(can, RT_DEVICE_CTRL_SET_INT, (void *)RT_DEVICE_FLAG_INT_TX);
@@ -346,25 +359,17 @@ static rt_err_t rt_can_open(struct rt_device *dev, rt_uint16_t oflag)
else
{
can->can_tx = RT_NULL;
- rt_exit_critical();
}
}
- else
- {
- rt_exit_critical();
- }
can->ops->control(can, RT_DEVICE_CTRL_SET_INT, (void *)RT_DEVICE_CAN_INT_ERR);
+
#ifdef RT_CAN_USING_HDR
- rt_enter_critical();
if (can->hdr == RT_NULL)
{
int i = 0;
struct rt_can_hdr *phdr;
- /* exit critical region for malloc a header. */
- rt_exit_critical();
-
phdr = (struct rt_can_hdr *) rt_malloc(can->config.maxhdr * sizeof(struct rt_can_hdr));
RT_ASSERT(phdr != RT_NULL);
rt_memset(phdr, 0, can->config.maxhdr * sizeof(struct rt_can_hdr));
@@ -373,45 +378,18 @@ static rt_err_t rt_can_open(struct rt_device *dev, rt_uint16_t oflag)
rt_list_init(&phdr[i].list);
}
- rt_enter_critical();
can->hdr = phdr;
- rt_exit_critical();
- }
- else
- {
- rt_exit_critical();
}
#endif
- rt_enter_critical();
if (!can->timerinitflag)
{
can->timerinitflag = 1;
- rt_exit_critical();
-#ifdef RT_CAN_USING_LED
- if (can->config.rcvled != RT_NULL)
- {
- rt_pin_mode(can->config.rcvled->pin, can->config.rcvled->mode);
- rt_pin_write(can->config.rcvled->pin, can->config.rcvled->init);
- }
- if (can->config.sndled != RT_NULL)
- {
- rt_pin_mode(can->config.sndled->pin, can->config.sndled->mode);
- rt_pin_write(can->config.sndled->pin, can->config.sndled->init);
- }
- if (can->config.errled != RT_NULL)
- {
- rt_pin_mode(can->config.errled->pin, can->config.errled->mode);
- rt_pin_write(can->config.errled->pin, can->config.errled->init);
- }
-#endif
rt_timer_start(&can->timer);
}
- else
- {
- rt_exit_critical();
- }
+
+ CAN_UNLOCK(can);
return RT_EOK;
}
@@ -423,48 +401,33 @@ static rt_err_t rt_can_close(struct rt_device *dev)
RT_ASSERT(dev != RT_NULL);
can = (struct rt_can_device *)dev;
+ CAN_LOCK(can);
+
/* this device has more reference count */
- if (dev->ref_count > 1) return RT_EOK;
+ if (dev->ref_count > 1)
+ {
+ CAN_UNLOCK(can);
+ return RT_EOK;
+ }
- rt_enter_critical();
if (can->timerinitflag)
{
can->timerinitflag = 0;
- rt_exit_critical();
+
rt_timer_stop(&can->timer);
-#ifdef RT_CAN_USING_LED
- rt_pin_write(can->config.rcvled->pin, can->config.rcvled->init);
- rt_pin_write(can->config.rcvled->pin, can->config.sndled->init);
- rt_pin_write(can->config.rcvled->pin, can->config.errled->init);
-#endif
- }
- else
- {
- rt_exit_critical();
}
- rt_enter_critical();
can->status_indicate.ind = RT_NULL;
can->status_indicate.args = RT_NULL;
- rt_exit_critical();
#ifdef RT_CAN_USING_HDR
- rt_enter_critical();
if (can->hdr != RT_NULL)
{
- struct rt_can_hdr *hdr;
-
- hdr = can->hdr;
+ rt_free(can->hdr);
can->hdr = RT_NULL;
- rt_exit_critical();
-
- rt_free(hdr);
- }
- else
- {
- rt_exit_critical();
}
#endif
+
if (dev->open_flag & RT_DEVICE_FLAG_INT_RX)
{
struct rt_can_rx_fifo *rx_fifo;
@@ -475,8 +438,9 @@ static rt_err_t rt_can_close(struct rt_device *dev)
rt_free(rx_fifo);
dev->open_flag &= ~RT_DEVICE_FLAG_INT_RX;
/* configure low level device */
- can->ops->control(can, RT_DEVICE_CTRL_CLR_INT, (void *)RT_DEVICE_FLAG_INT_TX);
+ can->ops->control(can, RT_DEVICE_CTRL_CLR_INT, (void *)RT_DEVICE_FLAG_INT_RX);
}
+
if (dev->open_flag & RT_DEVICE_FLAG_INT_TX)
{
struct rt_can_tx_fifo *tx_fifo;
@@ -489,7 +453,11 @@ static rt_err_t rt_can_close(struct rt_device *dev)
/* configure low level device */
can->ops->control(can, RT_DEVICE_CTRL_CLR_INT, (void *)RT_DEVICE_FLAG_INT_TX);
}
+
can->ops->control(can, RT_DEVICE_CTRL_CLR_INT, (void *)RT_DEVICE_CAN_INT_ERR);
+
+ CAN_UNLOCK(can);
+
return RT_EOK;
}
@@ -505,7 +473,7 @@ static rt_size_t rt_can_read(struct rt_device *dev,
can = (struct rt_can_device *)dev;
- if (dev->open_flag & RT_DEVICE_FLAG_INT_RX)
+ if ((dev->open_flag & RT_DEVICE_FLAG_INT_RX) && (dev->ref_count > 0))
{
return _can_int_rx(can, buffer, size);
}
@@ -525,7 +493,7 @@ static rt_size_t rt_can_write(struct rt_device *dev,
can = (struct rt_can_device *)dev;
- if (dev->open_flag & RT_DEVICE_FLAG_INT_TX)
+ if ((dev->open_flag & RT_DEVICE_FLAG_INT_TX) && (dev->ref_count > 0))
{
if (can->config.privmode)
{
@@ -573,10 +541,8 @@ static rt_err_t rt_can_control(struct rt_device *dev,
rt_base_t level;
struct rt_can_tx_fifo *tx_fifo;
- if (res = can->ops->control(can, cmd, args) != RT_EOK)
- {
- return res;
- }
+ res = can->ops->control(can, cmd, args);
+ if (res != RT_EOK) return res;
tx_fifo = (struct rt_can_tx_fifo *) can->can_tx;
if (can->config.privmode)
@@ -595,7 +561,7 @@ static rt_err_t rt_can_control(struct rt_device *dev,
for (i = 0; i < can->config.sndboxnumber; i++)
{
level = rt_hw_interrupt_disable();
- if (tx_fifo->buffer[i].result == RT_CAN__SND_RESUTL_OK)
+ if (tx_fifo->buffer[i].result == RT_CAN_SND_RESULT_OK)
{
rt_list_insert_before(&tx_fifo->freelist, &tx_fifo->buffer[i].list);
}
@@ -605,10 +571,12 @@ static rt_err_t rt_can_control(struct rt_device *dev,
return RT_EOK;
}
break;
+
case RT_CAN_CMD_SET_STATUS_IND:
can->status_indicate.ind = ((rt_can_status_ind_type_t)args)->ind;
can->status_indicate.args = ((rt_can_status_ind_type_t)args)->args;
break;
+
#ifdef RT_CAN_USING_HDR
case RT_CAN_CMD_SET_FILTER:
res = can->ops->control(can, cmd, args);
@@ -636,8 +604,8 @@ static rt_err_t rt_can_control(struct rt_device *dev,
pitem++;
continue;
}
- level = rt_hw_interrupt_disable();
+ level = rt_hw_interrupt_disable();
if (!can->hdr[pitem->hdr].connected)
{
rt_memcpy(&can->hdr[pitem->hdr].filter, pitem,
@@ -647,6 +615,7 @@ static rt_err_t rt_can_control(struct rt_device *dev,
rt_list_init(&can->hdr[pitem->hdr].list);
}
rt_hw_interrupt_enable(level);
+
count--;
pitem++;
}
@@ -682,6 +651,7 @@ static rt_err_t rt_can_control(struct rt_device *dev,
}
break;
#endif /*RT_CAN_USING_HDR*/
+
default :
/* control device */
if (can->ops->control != RT_NULL)
@@ -699,105 +669,14 @@ static rt_err_t rt_can_control(struct rt_device *dev,
*/
static void cantimeout(void *arg)
{
-#ifdef RT_CAN_USING_LED
- rt_uint32_t ledonflag = 0;
-#endif /*RT_CAN_USING_LED*/
rt_can_t can = (rt_can_t)arg;
rt_device_control((rt_device_t)can, RT_CAN_CMD_GET_STATUS, (void *)&can->status);
if (can->timerinitflag == 1)
{
-#ifdef RT_CAN_USING_LED
- ledonflag = 1;
-#endif /*RT_CAN_USING_LED*/
can->timerinitflag = 0xFF;
}
-#ifdef RT_CAN_USING_LED
- if (can->config.rcvled != RT_NULL && can->config.sndled == RT_NULL)
- {
- if (ledonflag == 1)
- {
- rt_pin_write(can->config.rcvled->pin, can->config.rcvled->init ? 0 : 1);
- }
- else
- {
- if (can->status.rcvchange == 1 || can->status.sndchange == 1)
- {
- can->status.rcvchange = 0;
- can->status.sndchange = 0;
- rt_pin_write(can->config.rcvled->pin, rt_pin_read(can->config.rcvled->pin) ? 0 : 1);
- }
- else
- {
- rt_pin_write(can->config.rcvled->pin, can->config.rcvled->init);
- }
- }
- }
- else if (can->config.rcvled != RT_NULL && can->config.sndled != RT_NULL)
- {
- if (ledonflag == 1)
- {
- rt_pin_write(can->config.rcvled->pin, can->config.rcvled->init ? 0 : 1);
- rt_pin_write(can->config.sndled->pin, can->config.sndled->init ? 0 : 1);
- }
- else
- {
- if (can->status.rcvchange == 1)
- {
- can->status.rcvchange = 0;
- rt_pin_write(can->config.rcvled->pin, rt_pin_read(can->config.rcvled->pin) ? 0 : 1);
- }
- else
- {
- rt_pin_write(can->config.rcvled->pin, can->config.rcvled->init);
- }
- if (can->status.sndchange == 1)
- {
- can->status.sndchange = 0;
- rt_pin_write(can->config.sndled->pin, rt_pin_read(can->config.sndled->pin) ? 0 : 1);
- }
- else
- {
- rt_pin_write(can->config.sndled->pin, can->config.sndled->init);
- }
- }
- }
- else if (can->config.rcvled == RT_NULL && can->config.sndled != RT_NULL)
- {
- if (ledonflag == 1)
- {
- rt_pin_write(can->config.sndled->pin, can->config.sndled->init ? 0 : 1);
- }
- else
- {
- if (can->status.rcvchange == 1 || can->status.sndchange == 1)
- {
- can->status.rcvchange = 0;
- can->status.sndchange = 0;
- rt_pin_write(can->config.sndled->pin, rt_pin_read(can->config.sndled->pin) ? 0 : 1);
- }
- else
- {
- rt_pin_write(can->config.sndled->pin, can->config.sndled->init);
- }
- }
- }
- if (ledonflag == 1)
- {
- rt_pin_write(can->config.errled->pin, can->config.errled->init ? 0 : 1);
- }
- else
- {
- if (can->status.errcode)
- {
- rt_pin_write(can->config.errled->pin, can->config.errled->init ? 0 : 1);
- }
- else
- {
- rt_pin_write(can->config.errled->pin, can->config.errled->init);
- }
- }
-#endif
+
if (can->status_indicate.ind != RT_NULL)
{
can->status_indicate.ind(can, can->status_indicate.args);
@@ -825,6 +704,8 @@ rt_err_t rt_hw_can_register(struct rt_can_device *can,
#endif
can->can_rx = RT_NULL;
can->can_tx = RT_NULL;
+ rt_mutex_init(&(can->lock), "can", RT_IPC_FLAG_PRIO);
+
device->init = rt_can_init;
device->open = rt_can_open;
device->close = rt_can_close;
@@ -838,7 +719,8 @@ rt_err_t rt_hw_can_register(struct rt_can_device *can,
rt_memset(&can->status, 0, sizeof(can->status));
device->user_data = data;
- can->timerinitflag = 0;
+
+ can->timerinitflag = 0;
rt_timer_init(&can->timer,
name,
cantimeout,
@@ -954,6 +836,7 @@ void rt_hw_can_isr(struct rt_can_device *can, int event)
}
else
#endif
+ {
if (can->parent.rx_indicate != RT_NULL)
{
rt_size_t rx_length;
@@ -965,6 +848,7 @@ void rt_hw_can_isr(struct rt_can_device *can, int event)
can->parent.rx_indicate(&can->parent, rx_length);
}
+ }
break;
}
@@ -976,13 +860,14 @@ void rt_hw_can_isr(struct rt_can_device *can, int event)
no = event >> 8;
tx_fifo = (struct rt_can_tx_fifo *) can->can_tx;
RT_ASSERT(tx_fifo != RT_NULL);
+
if ((event & 0xff) == RT_CAN_EVENT_TX_DONE)
{
- tx_fifo->buffer[no].result = RT_CAN__SND_RESUTL_OK;
+ tx_fifo->buffer[no].result = RT_CAN_SND_RESULT_OK;
}
else
{
- tx_fifo->buffer[no].result = RT_CAN__SND_RESUTL_ERR;
+ tx_fifo->buffer[no].result = RT_CAN_SND_RESULT_ERR;
}
rt_completion_done(&(tx_fifo->buffer[no].completion));
break;
@@ -1055,3 +940,4 @@ int cmd_canstat(int argc, void **argv)
}
FINSH_FUNCTION_EXPORT_ALIAS(cmd_canstat, __cmd_canstat, Stat Can Device Status.);
#endif
+