From 9a4cd2eaee7d389f2fa6e0d79f0f6ea526f7ef85 Mon Sep 17 00:00:00 2001 From: Cástor Muñoz Date: Sat, 14 May 2016 14:24:49 +0200 Subject: iPod Nano2G: add IPOD_ACCESSORY_PROTOCOL Change-Id: I78a19972624504bc802d96b9b8e9cec132164c2c --- .../target/arm/s5l8700/ipodnano2g/serial-nano2g.c | 113 +++++++++++++++++++++ firmware/target/arm/s5l8700/system-s5l8700.c | 12 ++- firmware/target/arm/s5l8700/uart-s5l8701.c | 17 +++- 3 files changed, 136 insertions(+), 6 deletions(-) (limited to 'firmware/target/arm') diff --git a/firmware/target/arm/s5l8700/ipodnano2g/serial-nano2g.c b/firmware/target/arm/s5l8700/ipodnano2g/serial-nano2g.c index 487984fbe3..5ff0b0ca25 100644 --- a/firmware/target/arm/s5l8700/ipodnano2g/serial-nano2g.c +++ b/firmware/target/arm/s5l8700/ipodnano2g/serial-nano2g.c @@ -47,6 +47,9 @@ extern const struct uartc s5l8701_uartc0; +#ifdef IPOD_ACCESSORY_PROTOCOL +void iap_rx_isr(int, char*, char*, uint32_t); +#endif struct uartc_port ser_port IDATA_ATTR = { @@ -61,7 +64,11 @@ struct uartc_port ser_port IDATA_ATTR = .clkhz = NANO2G_UART_CLK_HZ, /* interrupt callbacks */ +#ifdef IPOD_ACCESSORY_PROTOCOL + .rx_cb = iap_rx_isr, +#else .rx_cb = NULL, +#endif .tx_cb = NULL, /* polling */ }; @@ -94,3 +101,109 @@ void tx_writec(unsigned char c) { uartc_port_tx_byte(&ser_port, c); } + + +#ifdef IPOD_ACCESSORY_PROTOCOL +#include "iap.h" + +static enum { + ABR_STATUS_LAUNCHED, /* ST_SYNC */ + ABR_STATUS_SYNCING, /* ST_SOF */ + ABR_STATUS_DONE +} abr_status; + +void serial_bitrate(int rate) +{ + logf("[%lu] serial_bitrate(%d)", (uint32_t)USEC_TIMER, rate); + + if (rate == 0) { + /* Using auto-bitrate (ABR) to detect accessory Tx speed: + * + * + Here: + * - Disable Rx logic to clean the FIFO and the shift + * register, thus no Rx data interrupts are generated. + * - Launch ABR and wait for a low pulse in Rx line. + * + * + In ISR, when a low pulse is detected (ideally it is the + * start bit of 0xff): + * - Calculate and configure detected speed. + * - Enable Rx to verify that the next received data frame + * is 0x55 or 0xff: + * - If so, it's assumed bit rate is correctly detected, + * it will not be modified until speed is changed using + * RB options menu. + * - If not, reset iAP state machine and launch a new ABR. + */ + uartc_port_set_rx_mode(&ser_port, UCON_MODE_DISABLED); + uartc_port_abr_start(&ser_port); + abr_status = ABR_STATUS_LAUNCHED; + } + else { + uint32_t brdata; + if (rate == 57600) brdata = BRDATA_57600; + else if (rate == 38400) brdata = BRDATA_38400; + else if (rate == 19200) brdata = BRDATA_19200; + else brdata = BRDATA_9600; + uartc_port_abr_stop(&ser_port); /* abort ABR if already launched */ + uartc_port_set_bitrate_raw(&ser_port, brdata); + uartc_port_set_rx_mode(&ser_port, UCON_MODE_INTREQ); + abr_status = ABR_STATUS_DONE; + } +} + +void iap_rx_isr(int len, char *data, char *err, uint32_t abr_cnt) +{ + /* ignore Rx errors, upper layer will discard bad packets */ + (void) err; + + static int sync_retry; + + if (abr_status == ABR_STATUS_LAUNCHED) { + /* autobauding */ + if (abr_cnt) { + #define BR2CNT(s) (NANO2G_UART_CLK_HZ / (unsigned)(s)) + if (abr_cnt < BR2CNT(57600*1.1) || abr_cnt > BR2CNT(9600*0.9)) { + /* detected speed out of range, relaunch ABR */ + uartc_port_abr_start(&ser_port); + return; + } + /* valid speed detected, select it */ + uint32_t brdata; + if (abr_cnt < BR2CNT(48000)) brdata = BRDATA_57600; + else if (abr_cnt < BR2CNT(33600)) brdata = BRDATA_38400; + else if (abr_cnt < BR2CNT(24000)) brdata = BRDATA_28800; + else if (abr_cnt < BR2CNT(14400)) brdata = BRDATA_19200; + else brdata = BRDATA_9600; + + /* set detected speed */ + uartc_port_set_bitrate_raw(&ser_port, brdata); + uartc_port_set_rx_mode(&ser_port, UCON_MODE_INTREQ); + + /* enter SOF state */ + iap_getc(0xff); + + abr_status = ABR_STATUS_SYNCING; + sync_retry = 2; /* we are expecting [0xff] 0x55 */ + } + } + + /* process received data */ + while (len--) + { + bool sync_done = !iap_getc(*data++); + + if (abr_status == ABR_STATUS_SYNCING) + { + if (sync_done) { + abr_status = ABR_STATUS_DONE; + } + else if (--sync_retry == 0) { + /* invalid speed detected, relaunch ABR + discarding remaining data (if any) */ + serial_bitrate(0); + break; + } + } + } +} +#endif /* IPOD_ACCESSORY_PROTOCOL */ diff --git a/firmware/target/arm/s5l8700/system-s5l8700.c b/firmware/target/arm/s5l8700/system-s5l8700.c index 728fea0432..226464fb08 100644 --- a/firmware/target/arm/s5l8700/system-s5l8700.c +++ b/firmware/target/arm/s5l8700/system-s5l8700.c @@ -85,6 +85,10 @@ default_interrupt(INT_ADC); #if CONFIG_CPU==S5L8701 default_interrupt(INT_UNK); default_interrupt(INT_UART2); +default_interrupt(EINT_G0); +default_interrupt(EINT_G1); +default_interrupt(EINT_G2); +default_interrupt(EINT_G3); #endif @@ -99,8 +103,8 @@ void INT_TIMER(void) #if CONFIG_CPU==S5L8701 static void (* const irqvector[])(void) = -{ /* still 90% unverified and probably incorrect */ - EXT0,EXT1,EXT2,EINT_VBUS,EINTG,INT_TIMER,INT_WDT,INT_UART2, +{ /* still 80% unverified and probably incorrect */ + EXT0,EINT_G0,EINT_G1,EINT_G2,EINT_G3,INT_TIMER,INT_WDT,INT_UART2, INT_UNK,INT_UNK,INT_DMA,INT_ALARM_RTC,INT_UART1,INT_UNK,INT_UNK,INT_USB_HOST, INT_USB_FUNC,INT_LCDC_0,INT_LCDC_1,INT_CALM,INT_ATA,INT_UNK,INT_SPDIF_OUT,INT_ECC, INT_SDCI,INT_LCD,INT_WHEEL,INT_IIC,RESERVED2,INT_MSTICK,INT_ADC_WAKEUP,INT_ADC @@ -117,8 +121,8 @@ static void (* const irqvector[])(void) = #if CONFIG_CPU==S5L8701 static const char * const irqname[] = -{ /* still 90% unverified and probably incorrect */ - "EXT0","EXT1","EXT2","EINT_VBUS","EINTG","INT_TIMER","INT_WDT","INT_UART2", +{ /* still 80% unverified and probably incorrect */ + "EXT0","EINT_G0","EINT_G1","EINT_G2","EINT_G3","INT_TIMER","INT_WDT","INT_UART2", "INT_UNK1","INT_UNK2","INT_DMA","INT_ALARM_RTC","INT_UART1","INT_UNK3","INT_UNK4","INT_USB_HOST", "INT_USB_FUNC","INT_LCDC_0","INT_LCDC_1","INT_CALM","INT_ATA","INT_UNK5","INT_SPDIF_OUT","INT_ECC", "INT_SDCI","INT_LCD","INT_WHEEL","INT_IIC","Reserved","INT_MSTICK","INT_ADC_WAKEUP","INT_ADC" diff --git a/firmware/target/arm/s5l8700/uart-s5l8701.c b/firmware/target/arm/s5l8700/uart-s5l8701.c index 00c9322e47..b9fb1632ac 100644 --- a/firmware/target/arm/s5l8700/uart-s5l8701.c +++ b/firmware/target/arm/s5l8700/uart-s5l8701.c @@ -68,7 +68,7 @@ static uint8_t clockgate_uartc[S5L8701_N_UARTC] = { CLOCKGATE_UARTC0, CLOCKGATE_UARTC1, CLOCKGATE_UARTC2 }; static int intmsk_uart[S5L8701_N_UARTC] = { - INTMSK_UART0, INTMSK_UART1, INTMSK_UART2 }; + INTMSK_EINTG0, INTMSK_UART1, INTMSK_UART2 }; /* * Device level functions specific to S5L8701 @@ -107,6 +107,7 @@ void uart_target_disable_gpio(int uart_id, int port_id) void uart_target_enable_irq(int uart_id, int port_id) { (void) port_id; + if (uart_id == 0) GPIOIC_INTEN(0) = 0x200; INTMSK |= intmsk_uart[uart_id]; } @@ -114,11 +115,13 @@ void uart_target_disable_irq(int uart_id, int port_id) { (void) port_id; INTMSK &= ~intmsk_uart[uart_id]; + if (uart_id == 0) GPIOIC_INTEN(0) = 0; } void uart_target_clear_irq(int uart_id, int port_id) { (void) port_id; + if (uart_id == 0) GPIOIC_INTSTAT(0) = 0x200; SRCPND |= intmsk_uart[uart_id]; } @@ -135,10 +138,20 @@ void uart_target_disable_clocks(int uart_id) /* * ISRs */ -void ICODE_ATTR INT_UART0(void) + +/* On Nano2G, PORT0 interrupts are not used when iAP is disabled */ +#if !defined(IPOD_NANO2G) || defined(IPOD_ACCESSORY_PROTOCOL) +/* + * UART0 IRQ is connected to EINTG0, this is a quick patch, a "real" + * EINT handler will be needed if in future we use more than one IRQ + * on this group. + */ +void ICODE_ATTR EINT_G0(void) { + GPIOIC_INTSTAT(0) = 0x200; /* clear external IRQ */ uartc_callback(&s5l8701_uartc0, 0); } +#endif /* UARTC1,2 not used on Nano2G */ #ifndef IPOD_NANO2G -- cgit v1.2.3