*/
+
+#include "hw/hw_i2s.h"
+
#include "cfg/cfg_i2s.h"
// Define log settings for cfg/log.h.
#include <drv/timer.h>
#include <drv/i2s.h>
+#include <drv/dmac_sam3.h>
+
+#include <mware/event.h>
+
#include <cpu/irq.h>
#include <io/cm3.h>
+
+#define I2S_DMAC_CH 3
+
struct I2sHardware
{
+ bool end;
};
struct I2sHardware i2s_hw;
-
-
-/* We divite for 2 because the min clock for i2s i MCLK/2 */
-#define MCK_DIV (CPU_FREQ / (48000 * CONFIG_WORD_BIT_SIZE * CONFIG_CHANNEL_NUM * 2))
-#define DATALEN ((CONFIG_WORD_BIT_SIZE - 1) & SSC_DATLEN_MASK)
-#define DELAY ((CONFIG_DELAY << SSC_STTDLY_SHIFT) & SSC_STTDLY_MASK)
-#define PERIOD ((CONFIG_PERIOD << (SSC_PERIOD_SHIFT)) & SSC_PERIOD_MASK)
-#define DATNB ((CONFIG_WORD_PER_FRAME << SSC_DATNB_SHIFT) & SSC_DATNB_MASK)
-#define FSLEN ((CONFIG_FRAME_SYNC_SIZE << SSC_FSLEN_SHIFT) & SSC_FSLEN_MASK)
-#define EXTRA_FSLEN (CONFIG_EXTRA_FRAME_SYNC_SIZE << SSC_FSLEN_EXT)
-
+static Event data_ready;
+
+DmacDesc lli0;
+DmacDesc lli1;
+DmacDesc *curr;
+DmacDesc *next;
+DmacDesc *prev;
+
+bool error = false;
+uint32_t cfg;
+uint32_t ctrla;
+uint32_t ctrlb;
+
+static int16_t *sample_buff;
+static size_t next_idx = 0;
+static size_t chunk_size = 0;
+static size_t remaing_size = 0;
+static size_t transfer_size = 0;
+static bool single_transfer;
static void sam3_i2s_txStop(I2s *i2s)
{
(void)i2s;
SSC_CR = BV(SSC_TXDIS);
+ dmac_stop(I2S_DMAC_CH);
+
+ i2s->hw->end = true;
+ remaing_size = 0;
+
+ event_do(&data_ready);
}
static void sam3_i2s_txWait(I2s *i2s)
{
(void)i2s;
+ event_wait(&data_ready);
+}
+
+static void i2s_dmac_irq(uint32_t status)
+{
+ I2S_STROBE_ON();
+ if (single_transfer)
+ {
+ single_transfer = false;
+ }
+ else
+ {
+ if (status & (BV(I2S_DMAC_CH) << DMAC_EBCIDR_ERR0))
+ {
+ error = true;
+ // Disable to reset channel and clear fifo
+ DMAC_CHDR = BV(I2S_DMAC_CH);
+ }
+ else
+ {
+ prev = curr;
+ curr = next;
+ next = prev;
+
+ curr->src_addr = (uint32_t)&sample_buff[next_idx];
+ curr->dst_addr = (uint32_t)&SSC_THR;
+ curr->dsc_addr = (uint32_t)next;
+ curr->ctrla = ctrla | (chunk_size & 0xffff);
+ curr->ctrlb = ctrlb & ~BV(DMAC_CTRLB_IEN);
+
+ remaing_size -= chunk_size;
+ next_idx += chunk_size;
+
+ if (remaing_size <= 0)
+ {
+ remaing_size = transfer_size;
+ next_idx = 0;
+ }
+ }
+ }
+ event_do(&data_ready);
+ I2S_STROBE_OFF();
}
static void sam3_i2s_txStart(I2s *i2s, void *buf, size_t len, size_t slice_len)
{
- (void)i2s;
- (void)buf;
- (void)len;
- (void)slice_len;
+ ASSERT(buf);
+ ASSERT(len >= slice_len);
+ ASSERT(!(len % slice_len));
+
+ i2s->hw->end = false;
+ single_transfer = false;
+
+ sample_buff = (int16_t *)buf;
+ next_idx = 0;
+ chunk_size = slice_len / 2;
+ remaing_size = len / 2;
+ transfer_size = len / 2;
+
+
+ //Confing DMAC
+ DMAC_CHDR = BV(I2S_DMAC_CH);
+ reg32_t reg = DMAC_EBCISR;
+
+ LOG_INFO("Start streaming [%08lx]\n", reg);
+
+ cfg = BV(DMAC_CFG_DST_H2SEL) | BV(DMAC_CFG_SOD) |
+ ((3 << DMAC_CFG_DST_PER_SHIFT) & DMAC_CFG_DST_PER_MASK) | (3 & DMAC_CFG_SRC_PER_MASK);
+ ctrla = DMAC_CTRLA_SRC_WIDTH_HALF_WORD | DMAC_CTRLA_DST_WIDTH_HALF_WORD;
+ ctrlb = DMAC_CTRLB_FC_MEM2PER_DMA_FC | DMAC_CTRLB_DST_INCR_FIXED | DMAC_CTRLB_SRC_INCR_INCREMENTING;
+
+ prev = &lli0;
+ curr = &lli0;
+ next = &lli1;
+
+ i2s->ctx.tx_callback(i2s, &sample_buff[0], chunk_size * 2);
+
+ lli0.src_addr = (uint32_t)&sample_buff[0];
+ lli0.dst_addr = (uint32_t)&SSC_THR;
+ lli0.dsc_addr = (uint32_t)next;
+ lli0.ctrla = ctrla | (chunk_size & 0xffff);
+ lli0.ctrlb = ctrlb & ~BV(DMAC_CTRLB_IEN);
+
+ remaing_size -= chunk_size;
+ next_idx += chunk_size;
+
+ if (chunk_size <= remaing_size)
+ {
+ i2s->ctx.tx_callback(i2s, &sample_buff[next_idx], chunk_size * 2);
+
+ prev = curr;
+ curr = next;
+ next = prev;
+
+ lli1.src_addr = (uint32_t)&sample_buff[next_idx];
+ lli1.dst_addr = (uint32_t)&SSC_THR;
+ lli1.dsc_addr = (uint32_t)next;
+ lli1.ctrla = ctrla | (chunk_size & 0xffff);
+ lli1.ctrlb = ctrlb & ~BV(DMAC_CTRLB_IEN);
+
+ remaing_size -= chunk_size;
+ next_idx += chunk_size;
+ }
+
+ dmac_setLLITransfer(I2S_DMAC_CH, &lli0, cfg);
+
+ if (dmac_start(I2S_DMAC_CH) < 0)
+ {
+ LOG_ERR("DMAC start[%x]\n", dmac_error(I2S_DMAC_CH));
+ return;
+ }
+
+ error = false;
+ SSC_CR = BV(SSC_TXEN);
+ I2S_STROBE_OFF();
+
+ while (1)
+ {
+ event_wait(&data_ready);
+ if (error)
+ {
+ LOG_ERR("Errow while streaming.\n");
+ break;
+ }
+
+ if (i2s->hw->end)
+ break;
+
+ i2s->ctx.tx_callback(i2s, &sample_buff[next_idx], chunk_size * 2);
+ cpu_relax();
+ }
}
static void sam3_i2s_rxStop(I2s *i2s)
static bool sam3_i2s_isTxFinish(struct I2s *i2s)
{
(void)i2s;
- return false;
+ return i2s->hw->end;
}
static bool sam3_i2s_isRxFinish(struct I2s *i2s)
{
(void)i2s;
- return false;
+ return 0;
}
static void sam3_i2s_txBuf(struct I2s *i2s, void *buf, size_t len)
{
(void)i2s;
- (void)buf;
- (void)len;
+
+ single_transfer = true;
+
+ uint32_t cfg = BV(DMAC_CFG_DST_H2SEL) |
+ ((3 << DMAC_CFG_DST_PER_SHIFT) & DMAC_CFG_DST_PER_MASK) | (3 & DMAC_CFG_SRC_PER_MASK);
+ uint32_t ctrla = DMAC_CTRLA_SRC_WIDTH_HALF_WORD | DMAC_CTRLA_DST_WIDTH_HALF_WORD;
+ uint32_t ctrlb = BV(DMAC_CTRLB_SRC_DSCR) | BV(DMAC_CTRLB_DST_DSCR) |
+ DMAC_CTRLB_FC_MEM2PER_DMA_FC |
+ DMAC_CTRLB_DST_INCR_FIXED | DMAC_CTRLB_SRC_INCR_INCREMENTING;
+
+ dmac_setSources(I2S_DMAC_CH, (uint32_t)buf, (uint32_t)&SSC_THR);
+ dmac_configureDmac(I2S_DMAC_CH, len, cfg, ctrla, ctrlb);
+ dmac_start(I2S_DMAC_CH);
+
+ SSC_CR = BV(SSC_TXEN);
}
static void sam3_i2s_rxBuf(struct I2s *i2s, void *buf, size_t len)
{
(void)i2s;
- (void)buf;
- (void)len;
+
+ uint32_t cfg = BV(DMAC_CFG_SRC_H2SEL) |
+ ((4 << DMAC_CFG_DST_PER_SHIFT) & DMAC_CFG_DST_PER_MASK) | (4 & DMAC_CFG_SRC_PER_MASK);
+ uint32_t ctrla = DMAC_CTRLA_SRC_WIDTH_HALF_WORD | DMAC_CTRLA_DST_WIDTH_HALF_WORD;
+ uint32_t ctrlb = BV(DMAC_CTRLB_SRC_DSCR) | BV(DMAC_CTRLB_DST_DSCR) |
+ DMAC_CTRLB_FC_PER2MEM_DMA_FC |
+ DMAC_CTRLB_DST_INCR_INCREMENTING | DMAC_CTRLB_SRC_INCR_FIXED;
+
+ dmac_setSources(I2S_DMAC_CH, (uint32_t)&SSC_RHR, (uint32_t)buf);
+ dmac_configureDmac(I2S_DMAC_CH, len / 2, cfg, ctrla, ctrlb);
+ dmac_start(I2S_DMAC_CH);
+
+ SSC_CR = BV(SSC_RXEN);
}
static int sam3_i2s_write(struct I2s *i2s, uint32_t sample)
{
(void)i2s;
- while(!(SSC_SR & BV(SSC_TXRDY)));
+
+ SSC_CR = BV(SSC_TXEN);
+ while(!(SSC_SR & BV(SSC_TXRDY)))
+ cpu_relax();
+
SSC_THR = sample;
return 0;
}
-
-
static uint32_t sam3_i2s_read(struct I2s *i2s)
{
(void)i2s;
- while(!(SSC_SR & BV(SSC_RXRDY)));
+
+ SSC_CR = BV(SSC_RXEN);
+ while(!(SSC_SR & BV(SSC_RXRDY)))
+ cpu_relax();
+
return SSC_RHR;
}
-/*
-static DECLARE_ISR(irq_ssc)
-{
-}
-*/
+
+/* We divite for 2 because the min clock for i2s i MCLK/2 */
+#define MCK_DIV (CPU_FREQ / (CONFIG_SAMPLE_FREQ * CONFIG_WORD_BIT_SIZE * CONFIG_CHANNEL_NUM * 2))
+#define DATALEN ((CONFIG_WORD_BIT_SIZE - 1) & SSC_DATLEN_MASK)
+#define DELAY ((CONFIG_DELAY << SSC_STTDLY_SHIFT) & SSC_STTDLY_MASK)
+#define PERIOD ((CONFIG_PERIOD << (SSC_PERIOD_SHIFT)) & SSC_PERIOD_MASK)
+#define DATNB ((CONFIG_WORD_PER_FRAME << SSC_DATNB_SHIFT) & SSC_DATNB_MASK)
+#define FSLEN ((CONFIG_FRAME_SYNC_SIZE << SSC_FSLEN_SHIFT) & SSC_FSLEN_MASK)
+#define EXTRA_FSLEN (CONFIG_EXTRA_FRAME_SYNC_SIZE << SSC_FSLEN_EXT)
+
void i2s_init(I2s *i2s, int channel)
{
(void)channel;
DB(i2s->ctx._type = I2S_SAM3X;)
i2s->hw = &i2s_hw;
+ I2S_STROBE_INIT();
+
PIOA_PDR = BV(SSC_TK) | BV(SSC_TF) | BV(SSC_TD);
PIO_PERIPH_SEL(PIOA_BASE, BV(SSC_TK) | BV(SSC_TF) | BV(SSC_TD), PIO_PERIPH_B);
PIOB_PDR = BV(SSC_RD) | BV(SSC_RF);
* - MSB
* - Frame sync output selection negative
*/
- SSC_TFMR = DATALEN | DATNB | FSLEN | EXTRA_FSLEN | BV(SSC_MSBF) | SSC_FSOS_POSITIVE;
+ SSC_TFMR = DATALEN | DATNB | FSLEN | EXTRA_FSLEN | BV(SSC_MSBF) | SSC_FSOS_NEGATIVE;
// Receiver should start on TX and take the clock from TK
SSC_RCMR = SSC_CKS_CLK | BV(SSC_CKI) | SSC_CKO_CONT | SSC_CKG_NONE | DELAY | PERIOD | SSC_START_TX;
- SSC_RFMR = DATALEN | DATNB | FSLEN | EXTRA_FSLEN | BV(SSC_MSBF) | SSC_FSOS_POSITIVE;
+ SSC_RFMR = DATALEN | DATNB | FSLEN | EXTRA_FSLEN | BV(SSC_MSBF) | SSC_FSOS_NEGATIVE;
SSC_IDR = 0xFFFFFFFF;
- SSC_CR = BV(SSC_TXEN) | BV(SSC_RXEN);
+
+ dmac_enableCh(I2S_DMAC_CH, i2s_dmac_irq);
+ event_initGeneric(&data_ready);
}
projects / bertos.git / blobdiff