diff options
Diffstat (limited to 'main/common/devices.c')
-rw-r--r-- | main/common/devices.c | 113 |
1 files changed, 60 insertions, 53 deletions
diff --git a/main/common/devices.c b/main/common/devices.c index 134c21c..ab639c8 100644 --- a/main/common/devices.c +++ b/main/common/devices.c @@ -1,7 +1,7 @@ /************************************************************************** * * Copyright (c) 2013 Alcatel-Lucent - * + * * Alcatel Lucent licenses this file to You under the Apache License, * Version 2.0 (the "License"); you may not use this file except in * compliance with the License. A copy of the License is contained the @@ -23,7 +23,7 @@ * This code provides the monitor with the ability to treat the peripherals * as an entry in a device table so that each device can be accessed through * read, write, ioctl, init, open and close. - * The device table header file is defined as part of the target-specific + * The device table header file is defined as part of the target-specific * code and contains all of the target-specific device entries. * * Original author: Ed Sutter (ed.sutter@alcatel-lucent.com) @@ -40,13 +40,13 @@ void devtbldump() { - int i; + int i; - /* Dump the device table and add an asterisk next to the console device. */ - for(i=0;i<DEVTOT;i++) { - printf("Dev %d: %s%s\n",i,devtbl[i].name, - ConsoleDevice == i ? " (console)" : ""); - } + /* Dump the device table and add an asterisk next to the console device. */ + for(i=0; i<DEVTOT; i++) { + printf("Dev %d: %s%s\n",i,devtbl[i].name, + ConsoleDevice == i ? " (console)" : ""); + } } /* isbaddev(): @@ -55,11 +55,11 @@ devtbldump() int isbaddev(int dev) { - if ((dev < 0) || (dev >= DEVTOT)) { - printf("Invalid device: %d\n",dev); - return(1); - } - return(0); + if((dev < 0) || (dev >= DEVTOT)) { + printf("Invalid device: %d\n",dev); + return(1); + } + return(0); } /* Upper half device driver interfaces: */ @@ -67,83 +67,90 @@ isbaddev(int dev) int init(int dev,ulong arg) { - if (isbaddev(dev) || !devtbl[dev].init) - return(-1); - return (devtbl[dev].init(arg)); + if(isbaddev(dev) || !devtbl[dev].init) { + return(-1); + } + return (devtbl[dev].init(arg)); } int open(int dev,ulong arg1,ulong arg2) { - if (isbaddev(dev) || !devtbl[dev].open) - return(-1); - return (devtbl[dev].open(arg1,arg2)); + if(isbaddev(dev) || !devtbl[dev].open) { + return(-1); + } + return (devtbl[dev].open(arg1,arg2)); } int close(int dev) { - if (isbaddev(dev) || !devtbl[dev].close) - return(-1); - return (devtbl[dev].close(dev)); + if(isbaddev(dev) || !devtbl[dev].close) { + return(-1); + } + return (devtbl[dev].close(dev)); } int ioctl(int dev,int func,ulong data1,ulong data2) { - if (isbaddev(dev) || !devtbl[dev].ctrl) - return(-1); - return (devtbl[dev].ctrl(func,data1,data2)); + if(isbaddev(dev) || !devtbl[dev].ctrl) { + return(-1); + } + return (devtbl[dev].ctrl(func,data1,data2)); } int read(int dev,char *buf,int cnt) { - if (isbaddev(dev) || !devtbl[dev].read) - return(-1); - return (devtbl[dev].read(buf,cnt)); + if(isbaddev(dev) || !devtbl[dev].read) { + return(-1); + } + return (devtbl[dev].read(buf,cnt)); } int write(int dev,char *buf,int cnt) { - if (isbaddev(dev) || !devtbl[dev].read) - return(-1); - return (devtbl[dev].write(buf,cnt)); + if(isbaddev(dev) || !devtbl[dev].read) { + return(-1); + } + return (devtbl[dev].write(buf,cnt)); } -/* devInit(): +/* devInit(): * Step through the device table and execute each devices' initialization * function (if any). If any device initialization fails, print out an * error message and immediately branch to the montor's command loop. - * Since it is through this point that the monitor's UARTs are first + * Since it is through this point that the monitor's UARTs are first * initialized, we pass in a baudrate that is then handed to each of the - * device initialization routines (although it is only used by serial + * device initialization routines (although it is only used by serial * devices). */ int devInit(int baud) { - int fd; + int fd; - if (baud == 0) - baud = ConsoleBaudRate; + if(baud == 0) { + baud = ConsoleBaudRate; + } - /* Keep track of the last baud rate, so that it can be used if the - * incoming baudrate is NULL. - */ - ConsoleBaudRate = baud; + /* Keep track of the last baud rate, so that it can be used if the + * incoming baudrate is NULL. + */ + ConsoleBaudRate = baud; - fd = 0; - for(fd=0;fd<DEVTOT;fd++) - { - /* If device table does not have an init function, skip over it. */ - if (!devtbl[fd].init) - continue; - if (devtbl[fd].init((ulong)baud) != 0) { - printf("devInit() <%s> FAILED\n",devtbl[fd].name); - CommandLoop(); - } - } - return(0); + fd = 0; + for(fd=0; fd<DEVTOT; fd++) { + /* If device table does not have an init function, skip over it. */ + if(!devtbl[fd].init) { + continue; + } + if(devtbl[fd].init((ulong)baud) != 0) { + printf("devInit() <%s> FAILED\n",devtbl[fd].name); + CommandLoop(); + } + } + return(0); } |