[PATCH] Updated Legacy code in arm csb336
Vipul Nayyar
nayyar_vipul at yahoo.com
Tue Jul 9 16:29:38 UTC 2013
---
c/src/lib/libbsp/arm/csb336/console/uart.c | 142 +++++++++++++++-----------
c/src/lib/libbsp/arm/csb336/network/network.c | 46 +++------
2 files changed, 96 insertions(+), 92 deletions(-)
diff --git a/c/src/lib/libbsp/arm/csb336/console/uart.c b/c/src/lib/libbsp/arm/csb336/console/uart.c
index 4dc409b..448aaa5 100644
--- a/c/src/lib/libbsp/arm/csb336/console/uart.c
+++ b/c/src/lib/libbsp/arm/csb336/console/uart.c
@@ -13,12 +13,12 @@
#include <libchip/sersupp.h>
#include <rtems/error.h>
#include <rtems/bspIo.h>
+#include <assert.h>
#include <termios.h>
#include <rtems/irq.h>
#include <bsp/irq.h>
#include <mc9328mxl.h>
-
/* Define this to use interrupt driver UART driver */
#define USE_INTERRUPTS 1
@@ -34,20 +34,23 @@ static int imx_uart_set_attrs(int, const struct termios *);
static void imx_uart_init(int minor);
static void imx_uart_set_baud(int, int);
static ssize_t imx_uart_poll_write(int, const char *, size_t);
+static int imx_uart_poll_read_char(int minor);
+static void imx_uart_poll_write_char(int minor, char c);
+static void _BSP_output_char(char c);
+static int _BSP_poll_char(void);
-#if defined(USE_INTERRUPTS)
+#if USE_INTERRUPTS
static void imx_uart_tx_isr(rtems_irq_hdl_param);
static void imx_uart_rx_isr(rtems_irq_hdl_param);
-static void imx_uart_isr_on(const rtems_irq_connect_data *irq);
-static void imx_uart_isr_off(const rtems_irq_connect_data *irq);
-static int imx_uart_isr_is_on(const rtems_irq_connect_data *irq);
+static void imx_uart_isr_on(const rtems_irq_number);
+static void imx_uart_isr_off(const rtems_irq_number);
static ssize_t imx_uart_intr_write(int, const char *, size_t);
+static rtems_vector_number imx_uart_name_transmit(int minor);
+static rtems_vector_number imx_uart_name_receive(int minor);
#endif
-
-
/* TERMIOS callbacks */
-#if defined(USE_INTERRUPTS)
+#if USE_INTERRUPTS
rtems_termios_callbacks imx_uart_cbacks = {
.firstOpen = imx_uart_first_open,
.lastClose = imx_uart_last_close,
@@ -71,11 +74,6 @@ rtems_termios_callbacks imx_uart_cbacks = {
};
#endif
-#if defined(USE_INTERRUPTS)
-static rtems_irq_connect_data imx_uart_tx_isr_data[NUM_DEVS];
-static rtems_irq_connect_data imx_uart_rx_isr_data[NUM_DEVS];
-#endif
-
typedef struct {
int minor;
mc9328mxl_uart_regs_t * regs;
@@ -184,17 +182,9 @@ static void imx_uart_init(int minor)
imx_uart_data[minor].idx = 0;
if (minor == 0) {
-#if defined(USE_INTERRUPTS)
- imx_uart_tx_isr_data[minor].name = BSP_INT_UART1_TX;
- imx_uart_rx_isr_data[minor].name = BSP_INT_UART1_RX;
-#endif
imx_uart_data[minor].regs =
(mc9328mxl_uart_regs_t *) MC9328MXL_UART1_BASE;
} else if (minor == 1) {
-#if defined(USE_INTERRUPTS)
- imx_uart_tx_isr_data[minor].name = BSP_INT_UART2_TX;
- imx_uart_rx_isr_data[minor].name = BSP_INT_UART2_RX;
-#endif
imx_uart_data[minor].regs =
(mc9328mxl_uart_regs_t *) MC9328MXL_UART2_BASE;
} else {
@@ -202,20 +192,6 @@ static void imx_uart_init(int minor)
__FUNCTION__, __LINE__, minor);
}
-#if defined(USE_INTERRUPTS)
- imx_uart_tx_isr_data[minor].hdl = imx_uart_tx_isr;
- imx_uart_tx_isr_data[minor].handle = &imx_uart_data[minor];
- imx_uart_tx_isr_data[minor].on = imx_uart_isr_on;
- imx_uart_tx_isr_data[minor].off = imx_uart_isr_off;
- imx_uart_tx_isr_data[minor].isOn = imx_uart_isr_is_on;
-
- imx_uart_rx_isr_data[minor].hdl = imx_uart_rx_isr;
- imx_uart_rx_isr_data[minor].handle = &imx_uart_data[minor];
- imx_uart_rx_isr_data[minor].on = imx_uart_isr_on;
- imx_uart_rx_isr_data[minor].off = imx_uart_isr_off;
- imx_uart_rx_isr_data[minor].isOn = imx_uart_isr_is_on;
-#endif
-
imx_uart_data[minor].regs->cr1 = (
MC9328MXL_UART_CR1_UARTCLKEN |
MC9328MXL_UART_CR1_UARTEN);
@@ -243,12 +219,30 @@ static void imx_uart_init(int minor)
static int imx_uart_first_open(int major, int minor, void *arg)
{
rtems_libio_open_close_args_t *args = arg;
+ rtems_status_code status = RTEMS_SUCCESSFUL;
imx_uart_data[minor].tty = args->iop->data1;
-#if defined(USE_INTERRUPTS)
- BSP_install_rtems_irq_handler(&imx_uart_tx_isr_data[minor]);
- BSP_install_rtems_irq_handler(&imx_uart_rx_isr_data[minor]);
+#if USE_INTERRUPTS
+ status = rtems_interrupt_handler_install(
+ imx_uart_name_transmit(minor),
+ "UART",
+ RTEMS_INTERRUPT_UNIQUE,
+ imx_uart_tx_isr,
+ &imx_uart_data[minor]
+ );
+ assert(status == RTEMS_SUCCESSFUL);
+ imx_uart_isr_on(imx_uart_name_transmit(minor));
+
+ status = rtems_interrupt_handler_install(
+ imx_uart_name_receive(minor),
+ "UART",
+ RTEMS_INTERRUPT_UNIQUE,
+ imx_uart_rx_isr,
+ &imx_uart_data[minor]
+ );
+ assert(status == RTEMS_SUCCESSFUL);
+ imx_uart_isr_on(imx_uart_name_receive(minor));
imx_uart_data[minor].regs->cr1 |= MC9328MXL_UART_CR1_RRDYEN;
#endif
@@ -258,9 +252,24 @@ static int imx_uart_first_open(int major, int minor, void *arg)
static int imx_uart_last_close(int major, int minor, void *arg)
{
-#if defined(USE_INTERRUPTS)
- BSP_remove_rtems_irq_handler(&imx_uart_tx_isr_data[minor]);
- BSP_remove_rtems_irq_handler(&imx_uart_rx_isr_data[minor]);
+#if USE_INTERRUPTS
+ rtems_status_code status = RTEMS_SUCCESSFUL;
+
+ imx_uart_isr_off(imx_uart_name_transmit(minor));
+ status = rtems_interrupt_handler_remove(
+ imx_uart_name_transmit(minor),
+ imx_uart_tx_isr,
+ &imx_uart_data[minor]
+ );
+ assert(status == RTEMS_SUCCESSFUL);
+
+ imx_uart_isr_off(imx_uart_name_receive(minor));
+ status = rtems_interrupt_handler_remove(
+ imx_uart_name_receive(minor),
+ imx_uart_rx_isr,
+ &imx_uart_data[minor]
+ );
+ assert(status == RTEMS_SUCCESSFUL);
#endif
return 0;
@@ -291,7 +300,7 @@ static ssize_t imx_uart_poll_write(int minor, const char *buf, size_t len)
}
-#if defined(USE_INTERRUPTS)
+#if USE_INTERRUPTS
static ssize_t imx_uart_intr_write(int minor, const char *buf, size_t len)
{
imx_uart_data[minor].buf = buf;
@@ -316,23 +325,14 @@ static int imx_uart_set_attrs(int minor, const struct termios *t)
return 0;
}
-#if defined(USE_INTERRUPTS)
-static void imx_uart_isr_on(const rtems_irq_connect_data *irq)
+#if USE_INTERRUPTS
+static void imx_uart_isr_on(const rtems_irq_number name)
{
- MC9328MXL_AITC_INTENNUM = irq->name;
+ MC9328MXL_AITC_INTENNUM = name;
}
-static void imx_uart_isr_off(const rtems_irq_connect_data *irq)
+static void imx_uart_isr_off(const rtems_irq_number name)
{
- MC9328MXL_AITC_INTDISNUM = irq->name;
-}
-static int imx_uart_isr_is_on(const rtems_irq_connect_data *irq)
-{
- int irq_num = (int)irq->name;
- if (irq_num < 32) {
- return MC9328MXL_AITC_INTENABLEL & (1 << irq_num);
- } else {
- return MC9328MXL_AITC_INTENABLEH & (1 << (irq_num - 32));
- }
+ MC9328MXL_AITC_INTDISNUM = name;
}
static void imx_uart_rx_isr(rtems_irq_hdl_param param)
@@ -369,6 +369,28 @@ static void imx_uart_tx_isr(rtems_irq_hdl_param param)
rtems_termios_dequeue_characters(uart_data->tty, len);
}
}
+
+static rtems_vector_number imx_uart_name_transmit(int minor)
+{
+ if (minor == 0) {
+ return BSP_INT_UART1_TX;
+ } else if (minor == 1) {
+ return BSP_INT_UART2_TX;
+ }
+
+ assert(0);
+}
+
+static rtems_vector_number imx_uart_name_receive(int minor)
+{
+ if (minor == 0) {
+ return BSP_INT_UART1_RX;
+ } else if (minor == 1) {
+ return BSP_INT_UART2_RX;
+ }
+
+ assert(0);
+}
#endif
/*
@@ -417,7 +439,7 @@ static void imx_uart_set_baud(int minor, int baud)
/*
* Polled, non-blocking read from UART
*/
-int imx_uart_poll_read_char(int minor)
+static int imx_uart_poll_read_char(int minor)
{
return imx_uart_poll_read(minor);
}
@@ -425,7 +447,7 @@ int imx_uart_poll_read_char(int minor)
/*
* Polled, blocking write from UART
*/
-void imx_uart_poll_write_char(int minor, char c)
+static void imx_uart_poll_write_char(int minor, char c)
{
imx_uart_poll_write(minor, &c, 1);
}
@@ -433,7 +455,7 @@ void imx_uart_poll_write_char(int minor, char c)
/*
* Functions for printk() and friends.
*/
-void _BSP_output_char(char c)
+static void _BSP_output_char(char c)
{
poll_write(c);
if (c == '\n') {
@@ -443,7 +465,7 @@ void _BSP_output_char(char c)
BSP_output_char_function_type BSP_output_char = _BSP_output_char;
-int _BSP_poll_char(void)
+static int _BSP_poll_char(void)
{
return poll_read();
}
diff --git a/c/src/lib/libbsp/arm/csb336/network/network.c b/c/src/lib/libbsp/arm/csb336/network/network.c
index e513595..f93fcc8 100644
--- a/c/src/lib/libbsp/arm/csb336/network/network.c
+++ b/c/src/lib/libbsp/arm/csb336/network/network.c
@@ -19,6 +19,7 @@
#include <errno.h>
#include <rtems/error.h>
#include <rtems/bspIo.h>
+#include <assert.h>
#include <sys/param.h>
#include <sys/mbuf.h>
@@ -39,19 +40,8 @@
#define START_TRANSMIT_EVENT RTEMS_EVENT_2
static void enet_isr(rtems_irq_hdl_param);
-static void enet_isr_on(const rtems_irq_connect_data *unused);
-static void enet_isr_off(const rtems_irq_connect_data *unused);
-static int enet_isr_is_on(const rtems_irq_connect_data *irq);
-
-/* Replace the first value with the clock's interrupt name. */
-rtems_irq_connect_data mc9328mxl_enet_isr_data = {
- .name = BSP_INT_GPIO_PORTA,
- .hdl = enet_isr,
- .handle = (void *)BSP_INT_GPIO_PORTA,
- .on = enet_isr_on,
- .off = enet_isr_off,
- .isOn = enet_isr_is_on,
-};
+static void enet_isr_on(void);
+
typedef struct {
unsigned long rx_packets; /* total packets received */
unsigned long tx_packets; /* total packets transmitted */
@@ -238,6 +228,7 @@ void mc9328mxl_enet_init_hw(mc9328mxl_enet_softc_t *sc)
{
uint16_t stat;
uint16_t my = 0;
+ rtems_status_code status = RTEMS_SUCCESSFUL;
lan91c11x_write_reg(LAN91C11X_RCR, LAN91C11X_RCR_RST);
lan91c11x_write_reg(LAN91C11X_RCR, 0);
@@ -334,7 +325,15 @@ void mc9328mxl_enet_init_hw(mc9328mxl_enet_softc_t *sc)
MC9328MXL_GPIOA_IMR |= bit(3);
/* Install the interrupt handler */
- BSP_install_rtems_irq_handler(&mc9328mxl_enet_isr_data);
+ status = rtems_interrupt_handler_install(
+ BSP_INT_GPIO_PORTA,
+ "Network",
+ RTEMS_INTERRUPT_UNIQUE,
+ enet_isr,
+ (void *)BSP_INT_GPIO_PORTA
+ );
+ assert(status == RTEMS_SUCCESSFUL);
+ enet_isr_on();
} /* mc9328mxl_enet_init_hw() */
@@ -602,7 +601,7 @@ void mc9328mxl_enet_stats (mc9328mxl_enet_softc_t *sc)
/* Enables mc9328mxl_enet interrupts. */
-static void enet_isr_on(const rtems_irq_connect_data *unused)
+static void enet_isr_on(void)
{
/* Enable interrupts */
MC9328MXL_AITC_INTENNUM = MC9328MXL_INT_GPIO_PORTA;
@@ -610,23 +609,6 @@ static void enet_isr_on(const rtems_irq_connect_data *unused)
return;
}
-/* Disables enet interrupts */
-static void enet_isr_off(const rtems_irq_connect_data *unused)
-{
- /* disable all various TX/RX interrupts */
- MC9328MXL_AITC_INTDISNUM = MC9328MXL_INT_GPIO_PORTA;
-
- return;
-}
-
-/* Tests to see if mc9328mxl_enet interrupts are enabled, and returns non-0 if so.
- * If interrupt is not enabled, returns 0.
- */
-static int enet_isr_is_on(const rtems_irq_connect_data *irq)
-{
- return MC9328MXL_AITC_INTENABLEL & (1 << MC9328MXL_INT_GPIO_PORTA);
-}
-
/* Driver ioctl handler */
static int
mc9328mxl_enet_ioctl (struct ifnet *ifp, ioctl_command_t command, caddr_t data)
--
1.7.11.7
More information about the devel
mailing list