static int graes_init3(struct drvmgr_dev *dev)
{
struct graes_priv *priv;
char prefix[32];
rtems_status_code status;
priv = dev->priv;
/* Do initialization */
if ( graes_driver_io_registered == 0) {
/* Register the I/O driver only once for all cores */
if ( graes_register_io(&graes_driver_io_major) ) {
/* Failed to register I/O driver */
DBG("GRAES[%d] Failed to register I/O driver\n", dev->minor_drv);
dev->priv = NULL;
return DRVMGR_FAIL;
}
graes_driver_io_registered = 1;
}
/* I/O system registered and initialized
* Now we take care of device initialization.
*/
if ( graes_device_init(priv) ) {
DBG("GRAES[%d] Failed to call graes_device_init\n", dev->minor_drv);
return DRVMGR_FAIL;
}
/* Get Filesystem name prefix */
prefix[0] = '\0';
if ( drvmgr_get_dev_prefix(dev, prefix) ) {
/* Failed to get prefix, make sure of a unique FS name
* by using the driver minor.
*/
sprintf(priv->devName, "/dev/graes%d", dev->minor_drv);
} else {
/* Got special prefix, this means we have a bus prefix
* And we should use our "bus minor"
*/
sprintf(priv->devName, "/dev/%sgraes%d", prefix, dev->minor_bus);
}
DBG("GRAES: add dev %s\n",priv->devName);
/* Register Device */
status = rtems_io_register_name(priv->devName, graes_driver_io_major, dev->minor_drv);
if (status != RTEMS_SUCCESSFUL) {
return status;
}
return DRVMGR_OK;
}
int apbuart_init1(struct drvmgr_dev *dev)
{
struct apbuart_priv *priv;
struct amba_dev_info *ambadev;
struct ambapp_core *pnpinfo;
union drvmgr_key_value *value;
char prefix[32];
unsigned int db;
static int first_uart = 1;
/* The default operation in AMP is to use APBUART[0] for CPU[0],
* APBUART[1] for CPU[1] and so on. The remaining UARTs is not used
* since we don't know how many CPU-cores there are. Note this only
* affects the on-chip amba bus (the root bus). The user can override
* the default resource sharing by defining driver resources for the
* APBUART devices on each AMP OS instance.
*/
#if defined(RTEMS_MULTIPROCESSING) && defined(LEON3)
if (drvmgr_on_rootbus(dev) && dev->minor_drv != LEON3_Cpu_Index &&
drvmgr_keys_get(dev, NULL) != 0) {
/* User hasn't configured on-chip APBUART, leave it untouched */
return DRVMGR_EBUSY;
}
#endif
DBG("APBUART[%d] on bus %s\n", dev->minor_drv, dev->parent->dev->name);
/* Private data was allocated and zeroed by driver manager */
priv = dev->priv;
if (!priv)
return DRVMGR_NOMEM;
priv->dev = dev;
/* Get device information from AMBA PnP information */
ambadev = (struct amba_dev_info *)priv->dev->businfo;
if (ambadev == NULL)
return -1;
pnpinfo = &ambadev->info;
priv->regs = (struct apbuart_regs *)pnpinfo->apb_slv->start;
/* Clear HW regs, leave baudrate register as it is */
priv->regs->status = 0;
/* leave Transmitter/receiver if this is the RTEMS debug UART (assume
* it has been setup by boot loader).
*/
db = 0;
#ifdef LEON3
if (priv->regs == leon3_debug_uart) {
db = priv->regs->ctrl & (LEON_REG_UART_CTRL_RE |
LEON_REG_UART_CTRL_TE |
LEON_REG_UART_CTRL_PE |
LEON_REG_UART_CTRL_PS);
}
#endif
/* Let UART debug tunnelling be untouched if Flow-control is set.
*
* With old APBUARTs debug is enabled by setting LB and FL, since LB or
* DB are not reset we can not trust them. However since FL is reset we
* guess that we are debugging if FL is already set, the debugger set
* either LB or DB depending on UART capabilities.
*/
if (priv->regs->ctrl & LEON_REG_UART_CTRL_FL) {
db |= priv->regs->ctrl & (LEON_REG_UART_CTRL_DB |
LEON_REG_UART_CTRL_LB | LEON_REG_UART_CTRL_FL);
}
priv->regs->ctrl = db;
priv->cap = probecap(priv->regs);
/* The system console and Debug console may depend on this device, so
* initialize it straight away.
*
* We default to have System Console on first APBUART, user may override
* this behaviour by setting the syscon option to 0.
*/
if (drvmgr_on_rootbus(dev) && first_uart) {
priv->condev.flags = CONSOLE_FLAG_SYSCON;
first_uart = 0;
} else {
priv->condev.flags = 0;
}
value = drvmgr_dev_key_get(priv->dev, "syscon", DRVMGR_KT_INT);
if (value) {
if (value->i)
priv->condev.flags |= CONSOLE_FLAG_SYSCON;
else
priv->condev.flags &= ~CONSOLE_FLAG_SYSCON;
}
/* Select 0=Polled, 1=IRQ, 2=Task-Driven UART Mode */
value = drvmgr_dev_key_get(priv->dev, "mode", DRVMGR_KT_INT);
if (value)
priv->mode = value->i;
else
priv->mode = TERMIOS_POLLED;
/* TERMIOS device handlers */
if (priv->mode == TERMIOS_IRQ_DRIVEN) {
priv->condev.handler = &handler_interrupt;
} else if (priv->mode == TERMIOS_TASK_DRIVEN) {
priv->condev.handler = &handler_task;
} else {
priv->condev.handler = &handler_polled;
}
priv->condev.fsname = NULL;
/* Get Filesystem name prefix */
prefix[0] = '\0';
if (drvmgr_get_dev_prefix(dev, prefix)) {
/* Got special prefix, this means we have a bus prefix
* And we should use our "bus minor"
*/
sprintf(priv->devName, "/dev/%sapbuart%d", prefix, dev->minor_bus);
priv->condev.fsname = priv->devName;
} else {
sprintf(priv->devName, "/dev/apbuart%d", dev->minor_drv);
}
/* Register it as a console device, the console driver will register
* a termios device as well
*/
console_dev_register(&priv->condev);
return DRVMGR_OK;
}