2007-10-30 03:46:57 -07:00
|
|
|
/*
|
|
|
|
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/>.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <ch.h>
|
|
|
|
|
|
|
|
#include "lpc214x.h"
|
|
|
|
#include "lpc214x_ssp.h"
|
|
|
|
|
|
|
|
static BYTE8 *ip, *op;
|
2007-10-30 09:32:55 -07:00
|
|
|
static int icnt, ocnt;
|
2007-10-30 03:46:57 -07:00
|
|
|
static t_sspnotify callback;
|
2007-10-30 09:32:55 -07:00
|
|
|
static void *cbpar;
|
2007-10-30 03:46:57 -07:00
|
|
|
|
|
|
|
void SSPIrq(void) {
|
2007-10-30 09:32:55 -07:00
|
|
|
SSP *ssp = SSPBase;
|
|
|
|
BYTE8 b;
|
|
|
|
|
|
|
|
while (ssp->SSP_MIS & (MIS_ROR | MIS_RT | MIS_RX | MIS_TX)) {
|
|
|
|
|
|
|
|
if (ssp->SSP_MIS & MIS_ROR)
|
|
|
|
chSysHalt();
|
|
|
|
|
|
|
|
if (ssp->SSP_MIS & (MIS_RX | MIS_RT)) {
|
|
|
|
ssp->SSP_ICR = ICR_RT;
|
|
|
|
while (ssp->SSP_SR & SR_RNE) {
|
|
|
|
b = ssp->SSP_DR;
|
|
|
|
if (ip)
|
|
|
|
*ip++ = b;
|
|
|
|
icnt--;
|
|
|
|
}
|
|
|
|
if (icnt <= 0) { /* It should never become less than zero */
|
|
|
|
t_sspnotify fn = callback;
|
|
|
|
callback = NULL;
|
|
|
|
ssp->SSP_IMSC = 0;
|
|
|
|
VICVectAddr = 0;
|
|
|
|
fn(cbpar);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
/* It is MIS_TX, no need to test it again. */
|
|
|
|
while (ocnt && (ssp->SSP_SR & SR_TNF)) {
|
|
|
|
if (op)
|
|
|
|
ssp->SSP_DR = *op++;
|
|
|
|
else
|
|
|
|
ssp->SSP_DR = 0xFF;
|
|
|
|
ocnt--;
|
|
|
|
}
|
|
|
|
if (!ocnt)
|
|
|
|
ssp->SSP_IMSC = IMSC_ROR | IMSC_RT | IMSC_RX;
|
|
|
|
}
|
|
|
|
VICVectAddr = 0;
|
2007-10-30 03:46:57 -07:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Starts an asynchronous SSP transfer.
|
|
|
|
* @param in pointer to the incoming data buffer, if this parameter is set to
|
|
|
|
* \p NULL then the incoming data is discarded.
|
|
|
|
* @param out pointer to the outgoing data buffer, if this parameter is set to
|
|
|
|
* \p NULL then 0xFF bytes will be output.
|
|
|
|
* @param n the number of bytes to be transferred
|
|
|
|
* @param fn callback function invoked when the operation is done
|
2007-10-30 09:32:55 -07:00
|
|
|
* @param par parameter to be passed to the callback function
|
|
|
|
* @return \p SSP_OK if the trasfer was started else \p SSP_RUNNING if a
|
2007-10-30 03:46:57 -07:00
|
|
|
* an operation was already started
|
|
|
|
*/
|
2007-10-30 09:32:55 -07:00
|
|
|
t_msg sspRWI(BYTE8 *in, BYTE8 *out, t_size n, t_sspnotify fn, void *par) {
|
2007-10-30 03:46:57 -07:00
|
|
|
|
|
|
|
if (callback)
|
|
|
|
return SSP_RUNNING;
|
|
|
|
|
2007-10-30 09:32:55 -07:00
|
|
|
callback = fn, cbpar = par, ip = in, op = out, icnt = ocnt = n;
|
2007-10-30 03:46:57 -07:00
|
|
|
SSPIMSC = IMSC_ROR | IMSC_RT | IMSC_RX | IMSC_TX;
|
|
|
|
return SSP_OK;
|
|
|
|
}
|
|
|
|
|
2007-10-30 09:32:55 -07:00
|
|
|
|
|
|
|
static void done(void *tp) {
|
|
|
|
|
|
|
|
chThdResumeI(tp);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Synchronous SSP transfer.
|
|
|
|
* @param in pointer to the incoming data buffer, if this parameter is set to
|
|
|
|
* \p NULL then the incoming data is discarded.
|
|
|
|
* @param out pointer to the outgoing data buffer, if this parameter is set to
|
|
|
|
* \p NULL then 0xFF bytes will be output.
|
|
|
|
* @param n the number of bytes to be transferred
|
|
|
|
* @return \p SSP_OK if the trasfer was performed else \p SSP_RUNNING if a
|
|
|
|
* an operation was already started
|
|
|
|
*/
|
|
|
|
t_msg sspRW(BYTE8 *in, BYTE8 *out, t_size n) {
|
|
|
|
|
|
|
|
chSysLock();
|
|
|
|
|
|
|
|
t_msg sts = sspRWI(in, out, n, done, chThdSelf());
|
|
|
|
if (sts == SSP_OK)
|
|
|
|
chSchGoSleepS(PRSUSPENDED);
|
|
|
|
|
|
|
|
chSysUnlock();
|
|
|
|
return sts;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Checks if a SSP operation is running.
|
|
|
|
* @return \p TRUE if an asynchronous operation is already running.
|
|
|
|
*/
|
|
|
|
BOOL sspIsRunningI(void) {
|
|
|
|
|
|
|
|
return callback != NULL;
|
|
|
|
}
|
|
|
|
|
2007-10-30 03:46:57 -07:00
|
|
|
/*
|
|
|
|
* SSP setup, must be invoked with interrupts disabled.
|
|
|
|
* Do not invoke while an operation is in progress.
|
|
|
|
*/
|
|
|
|
void SetSSPI(int cpsr, int cr0, int cr1) {
|
|
|
|
SSP *ssp = SSPBase;
|
|
|
|
|
|
|
|
ssp->SSP_CR1 = cr1 & ~CR1_SSE;
|
|
|
|
ssp->SSP_CR0 = cr0;
|
|
|
|
ssp->SSP_CPSR = cpsr;
|
|
|
|
ssp->SSP_CR1 = cr1 | CR1_SSE;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* SSP subsystem initialization.
|
|
|
|
*/
|
|
|
|
void InitSSP(void) {
|
|
|
|
|
|
|
|
/* Enables the SPI1 clock */
|
|
|
|
PCONP = (PCONP & PCALL) | PCSPI1;
|
|
|
|
|
|
|
|
/* Clock = PCLK / 2 */
|
|
|
|
SetSSPI(2, CR0_DSS8BIT | CR0_FRFSPI | CR0_CLOCKRATE(0), 0);
|
|
|
|
|
|
|
|
VICIntEnable = INTMASK(SOURCE_SPI1);
|
|
|
|
}
|