196 lines
6.5 KiB
C
196 lines
6.5 KiB
C
/*
|
|
ChibiOS/RT - Copyright (C) 2006-2007 Giovanni Di Sirio.
|
|
|
|
This file is part of ChibiOS/RT.
|
|
|
|
ChibiOS/RT 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 3 of the License, or
|
|
(at your option) any later version.
|
|
|
|
ChibiOS/RT 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, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
/**
|
|
* @addtogroup Serial
|
|
* @{
|
|
*/
|
|
|
|
#include <ch.h>
|
|
|
|
#ifdef CH_USE_SERIAL_FULLDUPLEX
|
|
|
|
/**
|
|
* Initializes a generic full duplex driver. The HW dependent part of the
|
|
* initialization has to be performed outside, usually in the hardware
|
|
* initialization code.
|
|
* @param sd pointer to a \p FullDuplexDriver structure
|
|
* @param ib pointer to a memory area allocated for the Input Queue buffer
|
|
* @param isize size of the Input Queue buffer
|
|
* @param inotify pointer to a callback function that is invoked when
|
|
* some data is read from the Queue. The value can be \p NULL.
|
|
* @param ob pointer to a memory area allocated for the Output Queue buffer
|
|
* @param osize size of the Output Queue buffer
|
|
* @param onotify pointer to a callback function that is invoked when
|
|
* some data is written in the Queue. The value can be \p NULL.
|
|
*/
|
|
void chFDDInit(FullDuplexDriver *sd,
|
|
BYTE8 *ib, t_size isize, t_qnotify inotify,
|
|
BYTE8 *ob, t_size osize, t_qnotify onotify) {
|
|
|
|
chIQInit(&sd->sd_iqueue, ib, isize, inotify);
|
|
chEvtInit(&sd->sd_ievent);
|
|
chOQInit(&sd->sd_oqueue, ob, osize, onotify);
|
|
chEvtInit(&sd->sd_oevent);
|
|
chEvtInit(&sd->sd_sevent);
|
|
sd->sd_flags = SD_NO_ERROR;
|
|
}
|
|
|
|
/**
|
|
* This function must be called from the input interrupt service routine in
|
|
* order to enqueue incoming data and generate the related events.
|
|
* @param sd pointer to a \p FullDuplexDriver structure
|
|
* @param b the byte to be written in the driver's Input Queue
|
|
*/
|
|
void chFDDIncomingDataI(FullDuplexDriver *sd, BYTE8 b) {
|
|
|
|
if (chIQPutI(&sd->sd_iqueue, b) < Q_OK)
|
|
chFDDAddFlagsI(sd, SD_OVERRUN_ERROR);
|
|
else
|
|
chEvtSendI(&sd->sd_ievent);
|
|
}
|
|
|
|
/**
|
|
* Must be called from the output interrupt service routine in order to get
|
|
* the next byte to be transmitted.
|
|
*
|
|
* @param sd pointer to a \p FullDuplexDriver structure
|
|
* @return the byte read from the driver's Output Queue or \p Q_EMPTY if the
|
|
* queue is empty (the lower driver usually disables the interrupt
|
|
* source when this happens).
|
|
*/
|
|
t_msg chFDDRequestDataI(FullDuplexDriver *sd) {
|
|
|
|
t_msg b = chOQGetI(&sd->sd_oqueue);
|
|
if (b < Q_OK)
|
|
chEvtSendI(&sd->sd_oevent);
|
|
return b;
|
|
}
|
|
|
|
/**
|
|
* Must be called from the I/O interrupt service routine in order to
|
|
* notify I/O conditions as errors, signals change etc.
|
|
* @param sd pointer to a \p FullDuplexDriver structure
|
|
* @param mask condition flags to be added to the mask
|
|
*/
|
|
void chFDDAddFlagsI(FullDuplexDriver *sd, t_dflags mask) {
|
|
|
|
sd->sd_flags |= mask;
|
|
chEvtSendI(&sd->sd_sevent);
|
|
}
|
|
|
|
/**
|
|
* This function returns and clears the errors mask associated to the driver.
|
|
* @param sd pointer to a \p FullDuplexDriver structure
|
|
* @return the condition flags modified since last time this function was
|
|
* invoked
|
|
*/
|
|
t_dflags chFDDGetAndClearFlags(FullDuplexDriver *sd) {
|
|
t_dflags mask;
|
|
|
|
mask = sd->sd_flags;
|
|
sd->sd_flags = SD_NO_ERROR;
|
|
return mask;
|
|
}
|
|
|
|
#endif /* CH_USE_SERIAL_FULLDUPLEX */
|
|
|
|
#ifdef CH_USE_SERIAL_HALFDUPLEX
|
|
/**
|
|
* Initializes a generic half duplex driver. The HW dependent part of the
|
|
* initialization has to be performed outside, usually in the hardware
|
|
* initialization code.
|
|
* @param sd pointer to a \p HalfDuplexDriver structure
|
|
* @param b pointer to a memory area allocated for the queue buffer
|
|
* @param size the buffer size
|
|
* @param inotify pointer to a callback function that is invoked when
|
|
* some data is read from the queue. The value can be \p NULL.
|
|
* @param onotify pointer to a callback function that is invoked when
|
|
* some data is written in the queue. The value can be \p NULL.
|
|
*/
|
|
void chHDDInit(HalfDuplexDriver *sd, BYTE8 *b, t_size size,
|
|
t_qnotify inotify, t_qnotify onotify) {
|
|
|
|
chHDQInit(&sd->sd_queue, b, size, inotify, onotify);
|
|
chEvtInit(&sd->sd_ievent);
|
|
chEvtInit(&sd->sd_oevent);
|
|
chEvtInit(&sd->sd_sevent);
|
|
sd->sd_flags = SD_NO_ERROR;
|
|
}
|
|
|
|
/**
|
|
* This function must be called from the input interrupt service routine in
|
|
* order to enqueue incoming data and generate the related events.
|
|
* @param sd pointer to a \p FullDuplexDriver structure
|
|
* @param b the byte to be written in the driver's Input Queue
|
|
*/
|
|
void chHDDIncomingDataI(HalfDuplexDriver *sd, BYTE8 b) {
|
|
|
|
if (chHDQPutReceiveI(&sd->sd_queue, b) < Q_OK)
|
|
chHDDAddFlagsI(sd, SD_OVERRUN_ERROR);
|
|
else
|
|
chEvtSendI(&sd->sd_ievent);
|
|
}
|
|
|
|
/**
|
|
* Must be called from the output interrupt service routine in order to get
|
|
* the next byte to be transmitted.
|
|
*
|
|
* @param sd pointer to a \p HalfDuplexDriver structure
|
|
* @return the byte read from the driver's Output Queue or \p Q_EMPTY if the
|
|
* queue is empty (the lower driver usually disables the interrupt
|
|
* source when this happens).
|
|
*/
|
|
t_msg chHDDRequestDataI(HalfDuplexDriver *sd) {
|
|
|
|
t_msg b = chHDQGetTransmitI(&sd->sd_queue);
|
|
if (b < Q_OK)
|
|
chEvtSendI(&sd->sd_oevent);
|
|
return b;
|
|
}
|
|
|
|
/**
|
|
* Must be called from the I/O interrupt service routine in order to
|
|
* notify I/O conditions as errors, signals change etc.
|
|
* @param sd pointer to a \p HalfDuplexDriver structure
|
|
* @param mask condition flags to be added to the mask
|
|
*/
|
|
void chHDDAddFlagsI(HalfDuplexDriver *sd, t_dflags mask) {
|
|
|
|
sd->sd_flags |= mask;
|
|
chEvtSendI(&sd->sd_sevent);
|
|
}
|
|
|
|
/**
|
|
* This function returns and clears the errors mask associated to the driver.
|
|
* @param sd pointer to a \p HalfDuplexDriver structure
|
|
* @return the condition flags modified since last time this function was
|
|
* invoked
|
|
*/
|
|
t_dflags chHDDGetAndClearFlags(HalfDuplexDriver *sd) {
|
|
t_dflags mask;
|
|
|
|
mask = sd->sd_flags;
|
|
sd->sd_flags = SD_NO_ERROR;
|
|
return mask;
|
|
}
|
|
#endif /* CH_USE_SERIAL_HALFDUPLEX */
|
|
|
|
/** @} */
|