Amador Valley High School Robotics Team
MODDMA GPDMA Controller fork EXPERIMENTAL -- do not use
Diff: MODDMA.cpp
- Revision:
- 8:cb4d323ce6fd
- Parent:
- 6:40d38be4bb59
- Child:
- 12:1dfee7208043
--- a/MODDMA.cpp Wed Nov 24 00:32:49 2010 +0000
+++ b/MODDMA.cpp Sat Feb 05 08:53:26 2011 +0000
@@ -1,150 +1,157 @@
-/*
- Copyright (c) 2010 Andy Kirkham
-
- Permission is hereby granted, free of charge, to any person obtaining a copy
- of this software and associated documentation files (the "Software"), to deal
- in the Software without restriction, including without limitation the rights
- to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
- copies of the Software, and to permit persons to whom the Software is
- furnished to do so, subject to the following conditions:
-
- The above copyright notice and this permission notice shall be included in
- all copies or substantial portions of the Software.
-
- THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
- IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
- FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
- AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
- LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
- OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
- THE SOFTWARE.
-*/
-
-#include "MODDMA.h"
-
-namespace AjK {
-
-// Create a "hook" for our ISR to make callbacks. Set by init()
-class MODDMA *moddma_p = (class MODDMA *)NULL;
-
-void
-MODDMA::Enable(CHANNELS ChannelNumber)
-{
- LPC_GPDMACH_TypeDef *pChannel = (LPC_GPDMACH_TypeDef *)Channel_p( ChannelNumber );
- pChannel->DMACCConfig |= _E;
-}
-
-bool
-MODDMA::Enabled(CHANNELS ChannelNumber)
-{
- LPC_GPDMACH_TypeDef *pChannel = (LPC_GPDMACH_TypeDef *)Channel_p( ChannelNumber );
- return (bool)(pChannel->DMACCConfig & _E);
-}
-
-void
-MODDMA::Disable(CHANNELS ChannelNumber)
-{
- LPC_GPDMACH_TypeDef *pChannel = (LPC_GPDMACH_TypeDef *)Channel_p( ChannelNumber );
- pChannel->DMACCConfig &= ~(_E);
-}
-
-bool
-MODDMA::isActive(CHANNELS ChannelNumber)
-{
- LPC_GPDMACH_TypeDef *pChannel = (LPC_GPDMACH_TypeDef *)Channel_p( ChannelNumber );
- return (bool)( pChannel->DMACCConfig & CxConfig_A() ) ;
-}
-
-void
-MODDMA::haltChannel(CHANNELS ChannelNumber)
-{
- LPC_GPDMACH_TypeDef *pChannel = (LPC_GPDMACH_TypeDef *)Channel_p( ChannelNumber );
- pChannel->DMACCConfig |= CxConfig_H();
-}
-
-uint32_t oldDMAHandler = 0;
-typedef void (*MODDMA_FN)(void);
-
-extern "C" void MODDMA_IRQHandler(void) {
- uint32_t channel_mask;
-
- if (moddma_p == (class MODDMA *)NULL) {
- if (oldDMAHandler) {
- ((MODDMA_FN)oldDMAHandler)();
- return;
- }
- else {
- error("Interrupt without instance");
- }
- }
-
- for (int channel_number = 0; channel_number < 8; channel_number++) {
- channel_mask = (1UL << channel_number);
- if (LPC_GPDMA->DMACIntStat & channel_mask) {
- if (LPC_GPDMA->DMACIntTCStat & channel_mask) {
- if (moddma_p->setups[channel_number] != (MODDMA_Config *)NULL) {
- moddma_p->setIrqProcessingChannel((MODDMA::CHANNELS)channel_number);
- moddma_p->setIrqType(MODDMA::TcIrq);
- moddma_p->setups[channel_number]->isrIntTCStat->call();
- moddma_p->isrIntTCStat.call();
- // The user callback should clear the IRQ. But if they forget
- // then the Mbed will lockup. So, check to see if the IRQ has
- // been dismissed, if not, we will dismiss it here.
- if (LPC_GPDMA->DMACIntTCStat & channel_mask) {
- LPC_GPDMA->DMACIntTCClear = channel_mask;
- }
- // If the user has left the channel enabled, disable it.
- // Not, we don't check Active here as it may block inside
- // an ISR, we just shut it down immediately. If the user
- // must wait for completion they should implement their
- // own ISR. But only disable if the LLI linked list register
- // is null otherwise we can crap out a series of transfers.
- if (moddma_p->Enabled( (MODDMA::CHANNELS)channel_number )) {
- if (moddma_p->lli(channel_number) == 0 ) {
- moddma_p->Disable( (MODDMA::CHANNELS)channel_number );
- }
- }
- }
- }
-
- if (LPC_GPDMA->DMACIntErrStat & channel_mask) {
- if (moddma_p->setups[channel_number] != (MODDMA_Config *)NULL) {
- moddma_p->setIrqProcessingChannel((MODDMA::CHANNELS)channel_number);
- moddma_p->setIrqType(MODDMA::ErrIrq);
- moddma_p->setups[channel_number]->isrIntErrStat->call();
- moddma_p->isrIntErrStat.call();
- // The user callback should clear the IRQ. But if they forget
- // then the Mbed will lockup. So, check to see if the IRQ has
- // been dismissed, if not, we will dismiss it here.
- if (LPC_GPDMA->DMACIntErrStat & channel_mask) {
- LPC_GPDMA->DMACIntErrClr = channel_mask;
- }
- // If the user has left the channel enabled, disable it.
- // Not, we don't check Active here as it may block inside
- // an ISR, we just shut it down immediately. If the user
- // must wait for completion they should implement their
- // own ISR. But only disable if the LLI linked list register
- // is null otherwise we can crap out a series of transfers.
- if (moddma_p->Enabled( (MODDMA::CHANNELS)channel_number )) {
- if (moddma_p->lli(channel_number) == 0 ) {
- moddma_p->Disable( (MODDMA::CHANNELS)channel_number );
- }
- }
- }
- }
- }
- }
-
- /* IRQ should be handled by now, check to make sure. */
- if (LPC_GPDMA->DMACIntStat) {
- ((MODDMA_FN)oldDMAHandler)();
- LPC_GPDMA->DMACIntTCClear = (uint32_t)0xFF; /* If not, clear anyway! */
- }
- if (LPC_GPDMA->DMACIntErrStat) {
- ((MODDMA_FN)oldDMAHandler)();
- LPC_GPDMA->DMACIntErrClr = (uint32_t)0xFF; /* If not, clear anyway! */
- }
-}
-
-}; // namespace AjK ends
-
+/*
+ Copyright (c) 2010 Andy Kirkham
+
+ Permission is hereby granted, free of charge, to any person obtaining a copy
+ of this software and associated documentation files (the "Software"), to deal
+ in the Software without restriction, including without limitation the rights
+ to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
+ copies of the Software, and to permit persons to whom the Software is
+ furnished to do so, subject to the following conditions:
+
+ The above copyright notice and this permission notice shall be included in
+ all copies or substantial portions of the Software.
+
+ THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+ AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
+ THE SOFTWARE.
+*/
+#include "iomacros.h"
+#include "MODDMA.h"
+
+namespace AjK {
+
+// Create a "hook" for our ISR to make callbacks. Set by init()
+class MODDMA *moddma_p = (class MODDMA *)NULL;
+
+void
+MODDMA::Enable(CHANNELS ChannelNumber)
+{
+ LPC_GPDMACH_TypeDef *pChannel = (LPC_GPDMACH_TypeDef *)Channel_p( ChannelNumber );
+ pChannel->DMACCConfig |= _E;
+}
+
+bool
+MODDMA::Enabled(CHANNELS ChannelNumber)
+{
+ LPC_GPDMACH_TypeDef *pChannel = (LPC_GPDMACH_TypeDef *)Channel_p( ChannelNumber );
+ return (bool)(pChannel->DMACCConfig & _E);
+}
+
+void
+MODDMA::Disable(CHANNELS ChannelNumber)
+{
+ LPC_GPDMACH_TypeDef *pChannel = (LPC_GPDMACH_TypeDef *)Channel_p( ChannelNumber );
+ pChannel->DMACCConfig &= ~(_E);
+}
+
+bool
+MODDMA::isActive(CHANNELS ChannelNumber)
+{
+ LPC_GPDMACH_TypeDef *pChannel = (LPC_GPDMACH_TypeDef *)Channel_p( ChannelNumber );
+ return (bool)( pChannel->DMACCConfig & CxConfig_A() ) ;
+}
+
+void
+MODDMA::haltChannel(CHANNELS ChannelNumber)
+{
+ LPC_GPDMACH_TypeDef *pChannel = (LPC_GPDMACH_TypeDef *)Channel_p( ChannelNumber );
+ pChannel->DMACCConfig |= CxConfig_H();
+}
+
+uint32_t
+MODDMA::getControl(CHANNELS ChannelNumber)
+{
+ LPC_GPDMACH_TypeDef *pChannel = (LPC_GPDMACH_TypeDef *)Channel_p( ChannelNumber );
+ return pChannel->DMACCControl;
+}
+
+uint32_t oldDMAHandler = 0;
+typedef void (*MODDMA_FN)(void);
+
+extern "C" void MODDMA_IRQHandler(void) {
+ uint32_t channel_mask;
+
+ if (moddma_p == (class MODDMA *)NULL) {
+ if (oldDMAHandler) {
+ ((MODDMA_FN)oldDMAHandler)();
+ return;
+ }
+ else {
+ error("Interrupt without instance");
+ }
+ }
+
+ for (int channel_number = 0; channel_number < 8; channel_number++) {
+ channel_mask = (1UL << channel_number);
+ if (LPC_GPDMA->DMACIntStat & channel_mask) {
+ if (LPC_GPDMA->DMACIntTCStat & channel_mask) {
+ if (moddma_p->setups[channel_number] != (MODDMA_Config *)NULL) {
+ moddma_p->setIrqProcessingChannel((MODDMA::CHANNELS)channel_number);
+ moddma_p->setIrqType(MODDMA::TcIrq);
+ moddma_p->setups[channel_number]->isrIntTCStat->call();
+ moddma_p->isrIntTCStat.call();
+ // The user callback should clear the IRQ. But if they forget
+ // then the Mbed will lockup. So, check to see if the IRQ has
+ // been dismissed, if not, we will dismiss it here.
+ if (LPC_GPDMA->DMACIntTCStat & channel_mask) {
+ LPC_GPDMA->DMACIntTCClear = channel_mask;
+ }
+ // If the user has left the channel enabled, disable it.
+ // Note, we don't check Active here as it may block inside
+ // an ISR, we just shut it down immediately. If the user
+ // must wait for completion they should implement their
+ // own ISR. But only disable if the LLI linked list register
+ // is null otherwise we can crap out a series of transfers.
+ if (moddma_p->Enabled( (MODDMA::CHANNELS)channel_number )) {
+ if (moddma_p->lli( (MODDMA::CHANNELS)channel_number ) == 0 ) {
+ moddma_p->Disable( (MODDMA::CHANNELS)channel_number );
+ }
+ }
+ }
+ }
+
+ if (LPC_GPDMA->DMACIntErrStat & channel_mask) {
+ if (moddma_p->setups[channel_number] != (MODDMA_Config *)NULL) {
+ moddma_p->setIrqProcessingChannel((MODDMA::CHANNELS)channel_number);
+ moddma_p->setIrqType(MODDMA::ErrIrq);
+ moddma_p->setups[channel_number]->isrIntErrStat->call();
+ moddma_p->isrIntErrStat.call();
+ // The user callback should clear the IRQ. But if they forget
+ // then the Mbed will lockup. So, check to see if the IRQ has
+ // been dismissed, if not, we will dismiss it here.
+ if (LPC_GPDMA->DMACIntErrStat & channel_mask) {
+ LPC_GPDMA->DMACIntErrClr = channel_mask;
+ }
+ // If the user has left the channel enabled, disable it.
+ // Not, we don't check Active here as it may block inside
+ // an ISR, we just shut it down immediately. If the user
+ // must wait for completion they should implement their
+ // own ISR. But only disable if the LLI linked list register
+ // is null otherwise we can crap out a series of transfers.
+ if (moddma_p->Enabled( (MODDMA::CHANNELS)channel_number )) {
+ if (moddma_p->lli( (MODDMA::CHANNELS)channel_number ) == 0 ) {
+ moddma_p->Disable( (MODDMA::CHANNELS)channel_number );
+ }
+ }
+ }
+ }
+ }
+ }
+
+ /* IRQ should be handled by now, check to make sure. */
+ if (LPC_GPDMA->DMACIntStat) {
+ ((MODDMA_FN)oldDMAHandler)();
+ LPC_GPDMA->DMACIntTCClear = (uint32_t)0xFF; /* If not, clear anyway! */
+ }
+ if (LPC_GPDMA->DMACIntErrStat) {
+ ((MODDMA_FN)oldDMAHandler)();
+ LPC_GPDMA->DMACIntErrClr = (uint32_t)0xFF; /* If not, clear anyway! */
+ }
+}
+
+}; // namespace AjK ends
+