From 03dd20706752e9fb20ad9464789ae45abde516db Mon Sep 17 00:00:00 2001 From: thierry Date: Thu, 3 May 2007 13:13:51 +0000 Subject: [PATCH 1/1] initial import --- CHANGELOG | 32 + Makefile | 52 ++ copying | 340 ++++++++ kfifo.c | 189 +++++ kfifo.h | 67 ++ nozomi.c | 2415 +++++++++++++++++++++++++++++++++++++++++++++++++++++ readme | 26 + todo | 6 + 8 files changed, 3127 insertions(+) create mode 100755 CHANGELOG create mode 100755 Makefile create mode 100755 copying create mode 100755 kfifo.c create mode 100755 kfifo.h create mode 100644 nozomi.c create mode 100755 readme create mode 100755 todo diff --git a/CHANGELOG b/CHANGELOG new file mode 100755 index 0000000..adc01b1 --- /dev/null +++ b/CHANGELOG @@ -0,0 +1,32 @@ +/* + * Version 2.1 + * Changelog moved to head of nozomi.c + * 03-Jul-2006 : Paul Hardwick + * + * Version 2.0 + * 08-feb-2006 15:34:10:Ulf + * + * -Fixed issue when not waking up line disipine layer, could probably result + * in better uplink performance for 2.4. + * + * -Fixed issue with big endian during initalization, now proper toggle flags + * are handled between preloader and maincode. + * + * -Fixed flow control issue. + * + * -Added support for setting DTR. + * + * -For 2.4 kernels, removing temporary buffer that's not needed. + * + * -Reading CTS only for modem port (only port that supports it). + * + * -Return 0 in write_room instead of netative value, it's not handled in + * upper layer. + * + * -------------------------------------------------------------------------- + * Version 1.0 + * + * First version of driver, only tested with card of type F32_2. + * Works fine with 2.4 and 2.6 kernels. + * Driver also support big endian architecture. + */ diff --git a/Makefile b/Makefile new file mode 100755 index 0000000..2a98557 --- /dev/null +++ b/Makefile @@ -0,0 +1,52 @@ +# if HW is PC_24 or PC_26 it compiles for kernel 2.4 resp 2.6 +HW=PC_26 + +#---------- FOR PC 2.6 kernel ----------------------------------- +ifeq ($(HW),PC_26) +ifneq ($(KERNELRELEASE),) +obj-m += nozomi.o +else +KDIR:=/lib/modules/$(shell uname -r)/build +INSTALLDIR:=/lib/modules/$(shell uname -r)/kernel/drivers/pci/hotplug +PWD := $(shell pwd) + +default: + @echo "Warning: Compiling for 2.6: $(FOR26)" + $(MAKE) -C $(KDIR) SUBDIRS=$(PWD) modules +endif +endif +#---------- FOR PC 2.4 kernel ----------------------------------- +ifeq ($(HW),PC_24) +#CC = gcc-2.95 +CC = gcc-3.3 +KERNELDIR = -I/usr/src/kernel-headers-2.4.27-2-686/include/ +CFLAGS = -Wall $(KERNELDIR) -O3 -D__KERNEL__ -DMODULE -c -DPC_KERNEL_24 +PWD := $(shell pwd) + +default: + @echo "Warning: Compiling for 2.4: $(FOR26)" + $(CC) $(CFLAGS) nozomi.c -c + $(CC) $(CFLAGS) kfifo.c -c + ld -r -o noz.o nozomi.o kfifo.o +endif +#---------------------------------------------------------------- + +c: clean +clean: + $(RM) *.o *.ko *.mod.* .*.o.cmd .*.mod.* .*.ko.cmd + $(RM) .tmp_versions -rf +#---------------------------------------------------------------- +t: tags +tags: ctags +ctags: + ctags-exuberant -e *.c + +ser: ser.c + $(CC) ser.c -o ser + +i: install +install: + -modprobe -r nozomi + cp -f nozomi.ko $(INSTALLDIR) + depmod +#------------------------------------------------ \ No newline at end of file diff --git a/copying b/copying new file mode 100755 index 0000000..3912109 --- /dev/null +++ b/copying @@ -0,0 +1,340 @@ + GNU GENERAL PUBLIC LICENSE + Version 2, June 1991 + + Copyright (C) 1989, 1991 Free Software Foundation, Inc. + 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA + Everyone is permitted to copy and distribute verbatim copies + of this license document, but changing it is not allowed. + + Preamble + + The licenses for most software are designed to take away your +freedom to share and change it. By contrast, the GNU General Public +License is intended to guarantee your freedom to share and change free +software--to make sure the software is free for all its users. This +General Public License applies to most of the Free Software +Foundation's software and to any other program whose authors commit to +using it. (Some other Free Software Foundation software is covered by +the GNU Library General Public License instead.) You can apply it to +your programs, too. + + When we speak of free software, we are referring to freedom, not +price. Our General Public Licenses are designed to make sure that you +have the freedom to distribute copies of free software (and charge for +this service if you wish), that you receive source code or can get it +if you want it, that you can change the software or use pieces of it +in new free programs; and that you know you can do these things. + + To protect your rights, we need to make restrictions that forbid +anyone to deny you these rights or to ask you to surrender the rights. +These restrictions translate to certain responsibilities for you if you +distribute copies of the software, or if you modify it. + + For example, if you distribute copies of such a program, whether +gratis or for a fee, you must give the recipients all the rights that +you have. You must make sure that they, too, receive or can get the +source code. And you must show them these terms so they know their +rights. + + We protect your rights with two steps: (1) copyright the software, and +(2) offer you this license which gives you legal permission to copy, +distribute and/or modify the software. + + Also, for each author's protection and ours, we want to make certain +that everyone understands that there is no warranty for this free +software. If the software is modified by someone else and passed on, we +want its recipients to know that what they have is not the original, so +that any problems introduced by others will not reflect on the original +authors' reputations. + + Finally, any free program is threatened constantly by software +patents. We wish to avoid the danger that redistributors of a free +program will individually obtain patent licenses, in effect making the +program proprietary. To prevent this, we have made it clear that any +patent must be licensed for everyone's free use or not licensed at all. + + The precise terms and conditions for copying, distribution and +modification follow. + + GNU GENERAL PUBLIC LICENSE + TERMS AND CONDITIONS FOR COPYING, DISTRIBUTION AND MODIFICATION + + 0. This License applies to any program or other work which contains +a notice placed by the copyright holder saying it may be distributed +under the terms of this General Public License. The "Program", below, +refers to any such program or work, and a "work based on the Program" +means either the Program or any derivative work under copyright law: +that is to say, a work containing the Program or a portion of it, +either verbatim or with modifications and/or translated into another +language. (Hereinafter, translation is included without limitation in +the term "modification".) Each licensee is addressed as "you". + +Activities other than copying, distribution and modification are not +covered by this License; they are outside its scope. The act of +running the Program is not restricted, and the output from the Program +is covered only if its contents constitute a work based on the +Program (independent of having been made by running the Program). +Whether that is true depends on what the Program does. + + 1. You may copy and distribute verbatim copies of the Program's +source code as you receive it, in any medium, provided that you +conspicuously and appropriately publish on each copy an appropriate +copyright notice and disclaimer of warranty; keep intact all the +notices that refer to this License and to the absence of any warranty; +and give any other recipients of the Program a copy of this License +along with the Program. + +You may charge a fee for the physical act of transferring a copy, and +you may at your option offer warranty protection in exchange for a fee. + + 2. You may modify your copy or copies of the Program or any portion +of it, thus forming a work based on the Program, and copy and +distribute such modifications or work under the terms of Section 1 +above, provided that you also meet all of these conditions: + + a) You must cause the modified files to carry prominent notices + stating that you changed the files and the date of any change. + + b) You must cause any work that you distribute or publish, that in + whole or in part contains or is derived from the Program or any + part thereof, to be licensed as a whole at no charge to all third + parties under the terms of this License. + + c) If the modified program normally reads commands interactively + when run, you must cause it, when started running for such + interactive use in the most ordinary way, to print or display an + announcement including an appropriate copyright notice and a + notice that there is no warranty (or else, saying that you provide + a warranty) and that users may redistribute the program under + these conditions, and telling the user how to view a copy of this + License. (Exception: if the Program itself is interactive but + does not normally print such an announcement, your work based on + the Program is not required to print an announcement.) + +These requirements apply to the modified work as a whole. If +identifiable sections of that work are not derived from the Program, +and can be reasonably considered independent and separate works in +themselves, then this License, and its terms, do not apply to those +sections when you distribute them as separate works. But when you +distribute the same sections as part of a whole which is a work based +on the Program, the distribution of the whole must be on the terms of +this License, whose permissions for other licensees extend to the +entire whole, and thus to each and every part regardless of who wrote it. + +Thus, it is not the intent of this section to claim rights or contest +your rights to work written entirely by you; rather, the intent is to +exercise the right to control the distribution of derivative or +collective works based on the Program. + +In addition, mere aggregation of another work not based on the Program +with the Program (or with a work based on the Program) on a volume of +a storage or distribution medium does not bring the other work under +the scope of this License. + + 3. You may copy and distribute the Program (or a work based on it, +under Section 2) in object code or executable form under the terms of +Sections 1 and 2 above provided that you also do one of the following: + + a) Accompany it with the complete corresponding machine-readable + source code, which must be distributed under the terms of Sections + 1 and 2 above on a medium customarily used for software interchange; or, + + b) Accompany it with a written offer, valid for at least three + years, to give any third party, for a charge no more than your + cost of physically performing source distribution, a complete + machine-readable copy of the corresponding source code, to be + distributed under the terms of Sections 1 and 2 above on a medium + customarily used for software interchange; or, + + c) Accompany it with the information you received as to the offer + to distribute corresponding source code. (This alternative is + allowed only for noncommercial distribution and only if you + received the program in object code or executable form with such + an offer, in accord with Subsection b above.) + +The source code for a work means the preferred form of the work for +making modifications to it. For an executable work, complete source +code means all the source code for all modules it contains, plus any +associated interface definition files, plus the scripts used to +control compilation and installation of the executable. However, as a +special exception, the source code distributed need not include +anything that is normally distributed (in either source or binary +form) with the major components (compiler, kernel, and so on) of the +operating system on which the executable runs, unless that component +itself accompanies the executable. + +If distribution of executable or object code is made by offering +access to copy from a designated place, then offering equivalent +access to copy the source code from the same place counts as +distribution of the source code, even though third parties are not +compelled to copy the source along with the object code. + + 4. You may not copy, modify, sublicense, or distribute the Program +except as expressly provided under this License. Any attempt +otherwise to copy, modify, sublicense or distribute the Program is +void, and will automatically terminate your rights under this License. +However, parties who have received copies, or rights, from you under +this License will not have their licenses terminated so long as such +parties remain in full compliance. + + 5. You are not required to accept this License, since you have not +signed it. However, nothing else grants you permission to modify or +distribute the Program or its derivative works. These actions are +prohibited by law if you do not accept this License. Therefore, by +modifying or distributing the Program (or any work based on the +Program), you indicate your acceptance of this License to do so, and +all its terms and conditions for copying, distributing or modifying +the Program or works based on it. + + 6. Each time you redistribute the Program (or any work based on the +Program), the recipient automatically receives a license from the +original licensor to copy, distribute or modify the Program subject to +these terms and conditions. You may not impose any further +restrictions on the recipients' exercise of the rights granted herein. +You are not responsible for enforcing compliance by third parties to +this License. + + 7. If, as a consequence of a court judgment or allegation of patent +infringement or for any other reason (not limited to patent issues), +conditions are imposed on you (whether by court order, agreement or +otherwise) that contradict the conditions of this License, they do not +excuse you from the conditions of this License. If you cannot +distribute so as to satisfy simultaneously your obligations under this +License and any other pertinent obligations, then as a consequence you +may not distribute the Program at all. For example, if a patent +license would not permit royalty-free redistribution of the Program by +all those who receive copies directly or indirectly through you, then +the only way you could satisfy both it and this License would be to +refrain entirely from distribution of the Program. + +If any portion of this section is held invalid or unenforceable under +any particular circumstance, the balance of the section is intended to +apply and the section as a whole is intended to apply in other +circumstances. + +It is not the purpose of this section to induce you to infringe any +patents or other property right claims or to contest validity of any +such claims; this section has the sole purpose of protecting the +integrity of the free software distribution system, which is +implemented by public license practices. Many people have made +generous contributions to the wide range of software distributed +through that system in reliance on consistent application of that +system; it is up to the author/donor to decide if he or she is willing +to distribute software through any other system and a licensee cannot +impose that choice. + +This section is intended to make thoroughly clear what is believed to +be a consequence of the rest of this License. + + 8. If the distribution and/or use of the Program is restricted in +certain countries either by patents or by copyrighted interfaces, the +original copyright holder who places the Program under this License +may add an explicit geographical distribution limitation excluding +those countries, so that distribution is permitted only in or among +countries not thus excluded. In such case, this License incorporates +the limitation as if written in the body of this License. + + 9. The Free Software Foundation may publish revised and/or new versions +of the General Public License from time to time. Such new versions will +be similar in spirit to the present version, but may differ in detail to +address new problems or concerns. + +Each version is given a distinguishing version number. If the Program +specifies a version number of this License which applies to it and "any +later version", you have the option of following the terms and conditions +either of that version or of any later version published by the Free +Software Foundation. If the Program does not specify a version number of +this License, you may choose any version ever published by the Free Software +Foundation. + + 10. If you wish to incorporate parts of the Program into other free +programs whose distribution conditions are different, write to the author +to ask for permission. For software which is copyrighted by the Free +Software Foundation, write to the Free Software Foundation; we sometimes +make exceptions for this. Our decision will be guided by the two goals +of preserving the free status of all derivatives of our free software and +of promoting the sharing and reuse of software generally. + + NO WARRANTY + + 11. BECAUSE THE PROGRAM IS LICENSED FREE OF CHARGE, THERE IS NO WARRANTY +FOR THE PROGRAM, TO THE EXTENT PERMITTED BY APPLICABLE LAW. EXCEPT WHEN +OTHERWISE STATED IN WRITING THE COPYRIGHT HOLDERS AND/OR OTHER PARTIES +PROVIDE THE PROGRAM "AS IS" WITHOUT WARRANTY OF ANY KIND, EITHER EXPRESSED +OR IMPLIED, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF +MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. THE ENTIRE RISK AS +TO THE QUALITY AND PERFORMANCE OF THE PROGRAM IS WITH YOU. SHOULD THE +PROGRAM PROVE DEFECTIVE, YOU ASSUME THE COST OF ALL NECESSARY SERVICING, +REPAIR OR CORRECTION. + + 12. IN NO EVENT UNLESS REQUIRED BY APPLICABLE LAW OR AGREED TO IN WRITING +WILL ANY COPYRIGHT HOLDER, OR ANY OTHER PARTY WHO MAY MODIFY AND/OR +REDISTRIBUTE THE PROGRAM AS PERMITTED ABOVE, BE LIABLE TO YOU FOR DAMAGES, +INCLUDING ANY GENERAL, SPECIAL, INCIDENTAL OR CONSEQUENTIAL DAMAGES ARISING +OUT OF THE USE OR INABILITY TO USE THE PROGRAM (INCLUDING BUT NOT LIMITED +TO LOSS OF DATA OR DATA BEING RENDERED INACCURATE OR LOSSES SUSTAINED BY +YOU OR THIRD PARTIES OR A FAILURE OF THE PROGRAM TO OPERATE WITH ANY OTHER +PROGRAMS), EVEN IF SUCH HOLDER OR OTHER PARTY HAS BEEN ADVISED OF THE +POSSIBILITY OF SUCH DAMAGES. + + END OF TERMS AND CONDITIONS + + How to Apply These Terms to Your New Programs + + If you develop a new program, and you want it to be of the greatest +possible use to the public, the best way to achieve this is to make it +free software which everyone can redistribute and change under these terms. + + To do so, attach the following notices to the program. It is safest +to attach them to the start of each source file to most effectively +convey the exclusion of warranty; and each file should have at least +the "copyright" line and a pointer to where the full notice is found. + + + Copyright (C) + + This program is free software; you can redistribute it and/or modify + it under the terms of the GNU General Public License as published by + the Free Software Foundation; either version 2 of the License, or + (at your option) any later version. + + This program is distributed in the hope that it will be useful, + but WITHOUT ANY WARRANTY; without even the implied warranty of + MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + GNU General Public License for more details. + + You should have received a copy of the GNU General Public License + along with this program; if not, write to the Free Software + Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA + + +Also add information on how to contact you by electronic and paper mail. + +If the program is interactive, make it output a short notice like this +when it starts in an interactive mode: + + Gnomovision version 69, Copyright (C) year name of author + Gnomovision comes with ABSOLUTELY NO WARRANTY; for details type `show w'. + This is free software, and you are welcome to redistribute it + under certain conditions; type `show c' for details. + +The hypothetical commands `show w' and `show c' should show the appropriate +parts of the General Public License. Of course, the commands you use may +be called something other than `show w' and `show c'; they could even be +mouse-clicks or menu items--whatever suits your program. + +You should also get your employer (if you work as a programmer) or your +school, if any, to sign a "copyright disclaimer" for the program, if +necessary. Here is a sample; alter the names: + + Yoyodyne, Inc., hereby disclaims all copyright interest in the program + `Gnomovision' (which makes passes at compilers) written by James Hacker. + + , 1 April 1989 + Ty Coon, President of Vice + +This General Public License does not permit incorporating your program into +proprietary programs. If your program is a subroutine library, you may +consider it more useful to permit linking proprietary applications with the +library. If this is what you want to do, use the GNU Library General +Public License instead of this License. diff --git a/kfifo.c b/kfifo.c new file mode 100755 index 0000000..d586368 --- /dev/null +++ b/kfifo.c @@ -0,0 +1,189 @@ +/* + * A simple kernel FIFO implementation. + * + * Copyright (C) 2004 Stelian Pop + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. + * + */ + +#include +#include +#include +#include +#include "kfifo.h" + + +/** + * kfifo_init - allocates a new FIFO using a preallocated buffer + * @buffer: the preallocated buffer to be used. + * @size: the size of the internal buffer, this have to be a power of 2. + * @gfp_mask: get_free_pages mask, passed to kmalloc() + * @lock: the lock to be used to protect the fifo buffer + * + * Do NOT pass the kfifo to kfifo_free() after use ! Simply free the + * struct kfifo with kfree(). + */ +struct kfifo *kfifo_init(unsigned char *buffer, unsigned int size, + unsigned int gfp_mask, void *lock) +{ + struct kfifo *fifo; + + /* size must be a power of 2 */ + BUG_ON(size & (size - 1)); + + fifo = kmalloc(sizeof(struct kfifo), gfp_mask); + if (!fifo) + return ERR_PTR(-ENOMEM); + + fifo->buffer = buffer; + fifo->size = size; + fifo->in = fifo->out = 0; + + return fifo; +} + +/** + * kfifo_alloc - allocates a new FIFO and its internal buffer + * @size: the size of the internal buffer to be allocated. + * @gfp_mask: get_free_pages mask, passed to kmalloc() + * @lock: the lock to be used to protect the fifo buffer + * + * The size will be rounded-up to a power of 2. + */ +struct kfifo *kfifo_alloc(unsigned int size, unsigned int gfp_mask, void *lock) +{ + unsigned char *buffer; + struct kfifo *ret; + + /* + * round up to the next power of 2, since our 'let the indices + * wrap' tachnique works only in this case. + */ + if (size & (size - 1)) { + BUG_ON(size > 0x80000000); + printk("Do not support no power of two!\n"); + //size = roundup_pow_of_two(size); + } + + buffer = kmalloc(size, gfp_mask); + if (!buffer) + return ERR_PTR(-ENOMEM); + + ret = kfifo_init(buffer, size, gfp_mask, lock); + + if (IS_ERR(ret)) + kfree(buffer); + + return ret; +} + +/** + * kfifo_free - frees the FIFO + * @fifo: the fifo to be freed. + */ +void kfifo_free(struct kfifo *fifo) +{ + kfree(fifo->buffer); + kfree(fifo); +} + +/** + * __kfifo_put - puts some data into the FIFO, no locking version + * @fifo: the fifo to be used. + * @buffer: the data to be added. + * @len: the length of the data to be added. + * + * This function copies at most 'len' bytes from the 'buffer' into + * the FIFO depending on the free space, and returns the number of + * bytes copied. + * + * Note that with only one concurrent reader and one concurrent + * writer, you don't need extra locking to use these functions. + */ +unsigned int __kfifo_put(struct kfifo *fifo, + unsigned char *buffer, unsigned int len) +{ + unsigned int l; + + len = min(len, fifo->size - fifo->in + fifo->out); + + /* first put the data starting from fifo->in to buffer end */ + l = min(len, fifo->size - (fifo->in & (fifo->size - 1))); + memcpy(fifo->buffer + (fifo->in & (fifo->size - 1)), buffer, l); + + /* then put the rest (if any) at the beginning of the buffer */ + memcpy(fifo->buffer, buffer + l, len - l); + + fifo->in += len; + + return len; +} + +/** __kfifio_put_user works like __kfifo_put, but copies data from + * user space. + */ + +unsigned int __kfifo_put_user(struct kfifo *fifo, + unsigned char *buffer, unsigned int len) +{ + unsigned int l; + + len = min(len, fifo->size - fifo->in + fifo->out); + + /* first put the data starting from fifo->in to buffer end */ + l = min(len, fifo->size - (fifo->in & (fifo->size - 1))); + copy_from_user(fifo->buffer + (fifo->in & (fifo->size - 1)), buffer, l); + + /* then put the rest (if any) at the beginning of the buffer */ + copy_from_user(fifo->buffer, buffer + l, len - l); + + fifo->in += len; + + return len; +} + + + +/** + * __kfifo_get - gets some data from the FIFO, no locking version + * @fifo: the fifo to be used. + * @buffer: where the data must be copied. + * @len: the size of the destination buffer. + * + * This function copies at most 'len' bytes from the FIFO into the + * 'buffer' and returns the number of copied bytes. + * + * Note that with only one concurrent reader and one concurrent + * writer, you don't need extra locking to use these functions. + */ +unsigned int __kfifo_get(struct kfifo *fifo, + unsigned char *buffer, unsigned int len) +{ + unsigned int l; + + len = min(len, fifo->in - fifo->out); + + /* first get the data from fifo->out until the end of the buffer */ + l = min(len, fifo->size - (fifo->out & (fifo->size - 1))); + memcpy(buffer, fifo->buffer + (fifo->out & (fifo->size - 1)), l); + + /* then get the rest (if any) from the beginning of the buffer */ + memcpy(buffer + l, fifo->buffer, len - l); + + fifo->out += len; + + return len; +} diff --git a/kfifo.h b/kfifo.h new file mode 100755 index 0000000..76a027f --- /dev/null +++ b/kfifo.h @@ -0,0 +1,67 @@ +/* + * A simple kernel FIFO implementation. + * + * Copyright (C) 2004 Stelian Pop + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. + * + */ +#ifndef _LINUX_KFIFO_H +#define _LINUX_KFIFO_H + +#ifdef __KERNEL__ + +#include + +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) +#warning "Don't include this header in 2.6, use header supplied with kernel" +#endif + +struct kfifo { + unsigned char *buffer; /* the buffer holding the data */ + unsigned int size; /* the size of the allocated buffer */ + unsigned int in; /* data is added at offset (in % size) */ + unsigned int out; /* data is extracted from off. (out % size) */ +}; + +extern struct kfifo *kfifo_init(unsigned char *buffer, unsigned int size, unsigned int gfp_mask, void *lock); +extern struct kfifo *kfifo_alloc(unsigned int size, unsigned int gfp_mask, void *lock); +extern void kfifo_free(struct kfifo *fifo); +extern unsigned int __kfifo_put(struct kfifo *fifo, unsigned char *buffer, unsigned int len); +extern unsigned int __kfifo_put_user(struct kfifo *fifo, unsigned char *buffer, unsigned int len); +extern unsigned int __kfifo_get(struct kfifo *fifo, unsigned char *buffer, unsigned int len); + +/** + * __kfifo_reset - removes the entire FIFO contents, no locking version + * @fifo: the fifo to be emptied. + */ +static inline void __kfifo_reset(struct kfifo *fifo) +{ + fifo->in = fifo->out = 0; +} + +/** + * __kfifo_len - returns the number of bytes available in the FIFO, no locking version + * @fifo: the fifo to be used. + */ +static inline unsigned int __kfifo_len(struct kfifo *fifo) +{ + return fifo->in - fifo->out; +} + +#else +#warning "don't include kernel headers in userspace" +#endif /* __KERNEL__ */ +#endif diff --git a/nozomi.c b/nozomi.c new file mode 100644 index 0000000..af41bb9 --- /dev/null +++ b/nozomi.c @@ -0,0 +1,2415 @@ +/* nozomi.c -- HSDPA driver Broadband Wireless Data Card - Globe Trotter +* +* Written by: Ulf Jakobsson, +* Jan �erfeldt, +* Stefan Thomasson, +* +* Maintained by: Paul Hardwick (p.hardwick@option.com) +* +* Patches: +* Locking code changes for Vodafone by Sphere Systems Ltd, +* Andrew Bird (ajb@spheresystems.co.uk ) +* & Phil Sanderson +* +* Source has been ported from an implementation made by Filip Aben @ Option +* +* -------------------------------------------------------------------------- + +Copyright (c) 2005,2006 Option Wireless Sweden AB +Copyright (c) 2006 Sphere Systems Ltd +Copyright (c) 2006 Option Wireless n/v +All rights Reserved. + +This program is free software; you can redistribute it and/or modify +it under the terms of the GNU General Public License as published by +the Free Software Foundation; either version 2 of the License, or +(at your option) any later version. + +This program is distributed in the hope that it will be useful, +but WITHOUT ANY WARRANTY; without even the implied warranty of +MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the +GNU General Public License for more details. + +You should have received a copy of the GNU General Public License +along with this program; if not, write to the Free Software +Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA + +* -------------------------------------------------------------------------- +*/ + +/* CHANGELOG +* Version 2.21alpha +* 17-Sept-2006 paul Hardwick +* -Fixed unseen! bug in termio settings +* -Removed more compile warnings +* Version 2.2alpha +* 10-Sept-2006 Paul Hardwick +* +* - A 2.6 kernel support version incorporating patches by GregKH +* - changes include: +* - module reference counting +* - improved device exit code +* - greater compliance to kernel guidelines +* +* - 2.4 kernels untested but included +* - Still supports 2.6.14 for Ubunto users. +* - Finally fixed compiler warnings +* +* Version 2.1 +* 03-July-2006 Paul Hardwick +* +* - Stability Improvements. Incorporated spinlock wraps patch. +* - Updated for newer 2.6.14+ kernels (tty_buffer_request_room) +* - using __devexit macro for tty +* +* +* Version 2.0 +* 08-feb-2006 15:34:10:Ulf +* +* -Fixed issue when not waking up line disipine layer, could probably result +* in better uplink performance for 2.4. +* +* -Fixed issue with big endian during initalization, now proper toggle flags +* are handled between preloader and maincode. +* +* -Fixed flow control issue. +* +* -Added support for setting DTR. +* +* -For 2.4 kernels, removing temporary buffer that's not needed. +* +* -Reading CTS only for modem port (only port that supports it). +* +* -Return 0 in write_room instead of netative value, it's not handled in +* upper layer. +* +* -------------------------------------------------------------------------- +* Version 1.0 +* +* First version of driver, only tested with card of type F32_2. +* Works fine with 2.4 and 2.6 kernels. +* Driver also support big endian architecture. +*/ + +/* TODO +* +* See TODO file in this package +*/ + +#include + +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,14) +#define KERNEL_2_6_14 +#endif +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,17) +#define KERNEL_2_6_18 +#endif + + +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) +#define KERNEL_2_6 +#elif LINUX_VERSION_CODE > KERNEL_VERSION(2,4,0) +#define KERNEL_2_4 +#endif + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#ifdef KERNEL_2_6 +#include +#else +#include "kfifo.h" +#endif +#include + +#ifdef KERNEL_2_4 + +#ifndef IRQ_NONE +#define IRQ_NONE +#endif + +#ifndef IRQ_HANDLED +#define IRQ_HANDLED +typedef void irqreturn_t; +#endif + +#endif + +#ifndef CONFIG_PCI +#error "This driver needs PCI support to be available" +#endif + +#define VERSION_STRING DRIVER_DESC " 2.21alpha (build date: " __DATE__ " " __TIME__ ")" + +/* Macros definitions */ + +/* Enable this to have a lot of debug printouts */ +/* #define NOZOMI_DEBUG */ + +/* Default debug printout level */ +#define NOZOMI_DEBUG_LEVEL 0x1 + +#define P_BUF_SIZE 128 +#define NFO( _err_flag_, args...) \ + do{ \ + char t_m_p_[P_BUF_SIZE]; \ + snprintf(t_m_p_, sizeof(t_m_p_), ##args); \ + printk( _err_flag_ "[%d] %s(): %s\n", __LINE__, __FUNCTION__, t_m_p_); \ +} while(0) + +#define ERR(args...) NFO( KERN_ERR, ##args) + +#define D1(args...) D_(0x01, ##args) +#define D2(args...) D_(0x02, ##args) +#define D3(args...) D_(0x04, ##args) +#define D4(args...) D_(0x08, ##args) +#define D5(args...) D_(0x10, ##args) +#define D6(args...) D_(0x20, ##args) +#define D7(args...) D_(0x40, ##args) +#define D8(args...) D_(0x80, ##args) + +#ifdef NOZOMI_DEBUG +#define D_(lvl, args...) D(lvl, ##args) + /* Do we need this settable at runtime? */ +static int nzdebug = NOZOMI_DEBUG_LEVEL; + +#define D(lvl, args...) do{if(lvl & nzdebug) NFO(KERN_DEBUG, ##args );}while(0) +#define D_(lvl, args...) D(lvl, ##args) + +/* These printouts are always printed */ + +#else +static const int nzdebug = 0; +#define D_(lvl, args...) +#endif + +/* TODO: rewrite to optimize macros... */ +#define SET_FCR(value__) \ + do { \ + writew((value__), (dc->REG_FCR )); \ +} while(0) + +#define SET_IER(value__, mask__) \ + do { \ + dc->ier_last_written = (dc->ier_last_written & ~mask__) | (value__ & mask__ );\ + writew( dc->ier_last_written, (dc->REG_IER));\ +} while(0) + +#define GET_IER(read_val__) \ + do { \ + (read_val__) = readw((dc->REG_IER));\ +} while(0) + +#define GET_IIR(read_val__) \ + do { \ + (read_val__) = readw( (dc->REG_IIR));\ +} while(0) + +#define GET_MEM(value__, addr__, length__) \ + do { \ +/* read_mem32( (u32*) (value__), (u32) (addr__), (length__)); */\ + read_mem32( (u32*) (value__), (addr__), (length__));\ +} while(0) + +#define GET_MEM_BUF(value__, addr__, length__) \ + do { \ +/* read_mem32_buf( (u32*) (value__), (u32) (addr__), (length__)); */\ + read_mem32_buf( (u32*) (value__), (addr__), (length__));\ +} while(0) + +#define SET_MEM(addr__, value__, length__) \ + do { \ + write_mem32( (addr__), (u32*) (value__), (length__));\ +} while(0) + +#define SET_MEM_BUF(addr__, value__, length__) \ + do { \ + write_mem32_buf( (addr__), (u32*) (value__), (length__));\ +} while(0) + +#define TMP_BUF_MAX 256 + +#define DUMP(buf__,len__) \ + do { \ + char tbuf[TMP_BUF_MAX]={0};\ + if (len__>1) {\ + snprintf(tbuf, len__ > TMP_BUF_MAX ? TMP_BUF_MAX : len__, "%s",buf__);\ + if(tbuf[len__-2] == '\r') {\ + tbuf[len__-2] = 'r';\ + }\ + D1( "SENDING: '%s' (%d+n)", tbuf, len__);\ + } else {\ + D1( "SENDING: '%s' (%d)", tbuf, len__);\ + }\ +} while(0) + +#define RELEVANT_IFLAG(iflag) ((iflag) & (IGNBRK|BRKINT|IGNPAR|PARMRK|INPCK)) + +/* Defines */ +#define NOZOMI_NAME "nozomi" +#define NOZOMI_NAME_TTY "nozomi_tty" +#define DRIVER_DESC "Nozomi driver" + +#define NTTY_TTY_MAJOR 241 +#define NTTY_TTY_MINORS MAX_PORT +#define NTTY_FIFO_BUFFER_SIZE 8192 + +/* Must be power of 2 */ +#define FIFO_BUFFER_SIZE_UL 8192 + +/* Size of tmp send buffer to card */ +#define SEND_BUF_MAX 1024 +#define RECEIVE_BUF_MAX 4 + +/* Our fake UART values */ +#define MCR_DTR 0x01 +#define MCR_RTS 0x02 +#define MCR_LOOP 0x04 +#define MSR_CTS 0x08 +#define MSR_CD 0x10 +#define MSR_RI 0x20 +#define MSR_DSR 0x40 + +/* Define all types of vendors and devices to support */ +#define VENDOR1 0x1931 /* Vendor Option */ +#define DEVICE1 0x000c /* HSDPA card */ + +#define R_IIR 0x0000 /* Interrupt Identity Register */ +#define R_FCR 0x0000 /* Flow Control Register */ +#define R_IER 0x0004 /* Interrupt Enable Register */ + +#define CONFIG_MAGIC 0xEFEFFEFE +#define TOGGLE_VALID 0x0000 + +/* Definition of interrupt tokens */ +#define MDM_DL1 0x0001 +#define MDM_UL1 0x0002 +#define MDM_DL2 0x0004 +#define MDM_UL2 0x0008 +#define DIAG_DL1 0x0010 +#define DIAG_DL2 0x0020 +#define DIAG_UL 0x0040 +#define APP1_DL 0x0080 +#define APP1_UL 0x0100 +#define APP2_DL 0x0200 +#define APP2_UL 0x0400 +#define CTRL_DL 0x0800 +#define CTRL_UL 0x1000 +#define RESET 0x8000 + +#define MDM_DL (MDM_DL1 | MDM_DL2) +#define MDM_UL (MDM_UL1 | MDM_UL2) +#define DIAG_DL (DIAG_DL1 | DIAG_DL2) + +/* modem signal definition */ +#define CTRL_DSR 0x0001 +#define CTRL_DCD 0x0002 +#define CTRL_RI 0x0004 +#define CTRL_CTS 0x0008 + +#define CTRL_DTR 0x0001 +#define CTRL_RTS 0x0002 + +#define MAX_PORT 4 +#define NOZOMI_MAX_PORTS 5 + +/* Type definitions */ + +/* There are two types of nozomi cards, one with 2048 memory and with 8192 memory */ +enum card_type { + F32_2 = 2048, /* Has 512 bytes downlink and uplink * 2 -> 2048 */ + F32_8 = 8192, /* Has 3072 bytes downlink and 1024 bytes uplink * 2 -> 8192 */ +}; + +/* Two different toggle channels exist */ +enum channel_type { + CH_A = 0, + CH_B = 1, +}; + +/* Port definition for the card regarding flow control */ +enum ctrl_port_type { + CTRL_CMD = 0x00, + CTRL_MDM = 0x01, + CTRL_DIAG = 0x02, + CTRL_APP1 = 0x03, + CTRL_APP2 = 0x04, + CTRL_ERROR = -1, +}; + +/* Ports that the nozomi has */ +enum port_type { + PORT_MDM = 0, + PORT_DIAG = 1, + PORT_APP1 = 2, + PORT_APP2 = 3, + PORT_CTRL = 4, + PORT_ERROR = -1, +}; + +#ifdef __ARMEB__ +/* Big endian */ + +typedef struct { + unsigned enabled:5; /* Toggle fields are valid if enabled is 0, else A-channels + must always be used. */ + unsigned diag_dl:1; + unsigned mdm_dl:1; + unsigned mdm_ul:1; +} __attribute__ ((packed)) toggles_t; + +/* Configuration table to read at startup of card */ +/* Is for now only needed during initialization phase */ +typedef struct { + u32 signature; + u16 product_information; + u16 version; + u8 pad3[3]; + toggles_t toggle; + u8 pad1[4]; + u16 dl_mdm_len1; /* If this is 64, it can hold 60 bytes + 4 that is length field */ + u16 dl_start; + + u16 dl_diag_len1; + u16 dl_mdm_len2; /* If this is 64, it can hold 60 bytes + 4 that is length field */ + u16 dl_app1_len; + + u16 dl_diag_len2; + u16 dl_ctrl_len; + u16 dl_app2_len; + u8 pad2[16]; + u16 ul_mdm_len1; + u16 ul_start; + u16 ul_diag_len; + u16 ul_mdm_len2; + u16 ul_app1_len; + u16 ul_app2_len; + u16 ul_ctrl_len; +} __attribute__ ((packed)) config_table_t; + +/* This stores all control downlink flags */ +typedef struct { + u8 port; + unsigned reserved:4; + unsigned CTS:1; + unsigned RI:1; + unsigned DCD:1; + unsigned DSR:1; +} __attribute__ ((packed)) ctrl_dl_t; + +/* This stores all control uplink flags */ +typedef struct { + u8 port; + unsigned reserved:6; + unsigned RTS:1; + unsigned DTR:1; +} __attribute__ ((packed)) ctrl_ul_t; + +#else +/* Little endian */ + +/* This represents the toggle information */ +typedef struct { + unsigned mdm_ul:1; + unsigned mdm_dl:1; + unsigned diag_dl:1; + unsigned enabled:5; /* Toggle fields are valid if enabled is 0, else A-channels + must always be used. */ +} __attribute__ ((packed)) toggles_t; + +/* Configuration table to read at startup of card */ +typedef struct { + u32 signature; + u16 version; + u16 product_information; + toggles_t toggle; + u8 pad1[7]; + u16 dl_start; + u16 dl_mdm_len1; /* If this is 64, it can hold 60 bytes + 4 that is length field */ + u16 dl_mdm_len2; + u16 dl_diag_len1; + u16 dl_diag_len2; + u16 dl_app1_len; + u16 dl_app2_len; + u16 dl_ctrl_len; + u8 pad2[16]; + u16 ul_start; + u16 ul_mdm_len2; + u16 ul_mdm_len1; + u16 ul_diag_len; + u16 ul_app1_len; + u16 ul_app2_len; + u16 ul_ctrl_len; +} __attribute__ ((packed)) config_table_t; + +/* This stores all control downlink flags */ +typedef struct { + unsigned DSR:1; + unsigned DCD:1; + unsigned RI:1; + unsigned CTS:1; + unsigned reserverd:4; + u8 port; +} __attribute__ ((packed)) ctrl_dl_t; + +/* This stores all control uplink flags */ +typedef struct { + unsigned DTR:1; + unsigned RTS:1; + unsigned reserved:6; + u8 port; +} __attribute__ ((packed)) ctrl_ul_t; +#endif + +/* This holds all information that is needed regarding a port */ +struct port { + u8 update_flow_control; + ctrl_ul_t ctrl_ul; + ctrl_dl_t ctrl_dl; + struct kfifo *fifo_ul; + void __iomem *dl_addr[2]; + u32 dl_size[2]; + u8 toggle_dl; + void __iomem *ul_addr[2]; + u32 ul_size[2]; + u8 toggle_ul; + u16 token_dl; + + struct tty_struct *tty; + int tty_open_count; + struct semaphore tty_sem; + wait_queue_head_t tty_wait; + struct async_icount tty_icount; + int tty_index; + u32 rx_data, tx_data; + u8 tty_dont_flip; + +}; + +/* Private data one for each card in the system */ +typedef struct { + void __iomem *base_addr; + u8 closing; + + /* Pointers to registers */ + void __iomem *REG_IIR; + void __iomem *REG_FCR; + void __iomem *REG_IER; + + u16 ier_last_written; + enum card_type card_type; + config_table_t config_table; /* Configuration table */ + struct pci_dev *pdev; + struct port port[NOZOMI_MAX_PORTS]; + u8 *send_buf; + + struct tty_driver *tty_driver; + +#ifdef KERNEL_2_4 + struct tty_struct *tty_table[NTTY_TTY_MINORS]; + struct tq_struct tty_flip_queue; + s32 tty_refcount; +#endif +#ifdef KERNEL_2_6 + struct workqueue_struct *tty_flip_wq; + struct work_struct tty_flip_wq_struct; +#endif + + struct termios *tty_termios[NTTY_TTY_MINORS]; + struct termios *tty_termios_locked[NTTY_TTY_MINORS]; + spinlock_t spin_mutex; + + u32 open_ttys; + struct proc_dir_entry *proc_entry; + +} dc_t; + +/* This is a data packet that is read or written to/from card */ +typedef struct { + u32 size; /* size is the length of the data buffer */ + u8 *data; +} __attribute__ ((packed)) buf_t; + +/* Function declarations */ +static int ntty_tty_init(dc_t * dc); +static void tty_flip_queue_function(void *tmp_dc); + +/* Global variables */ +static struct pci_device_id nozomi_pci_tbl[] = { + {VENDOR1, DEVICE1}, + {0,} +}; + +/* Used to store interrupt variables */ +typedef struct { + u16 read_iir; /* Holds current interrupt tokens */ +} irq_t; + +MODULE_DEVICE_TABLE(pci, nozomi_pci_tbl); + +/* Representing the pci device of interest */ +static int cards_found; +static dc_t *my_dev = NULL; +static irq_t my_irq; + +static inline dc_t *get_dc_by_pdev(struct pci_dev *pdev) +{ + return my_dev; +} + +static inline dc_t *get_dc_by_index(s32 index) +{ + return my_dev; +} + +static inline s32 get_index(struct tty_struct *tty) +{ +#ifdef KERNEL_2_6 + return tty->index; +#else + return MINOR(tty->device) - tty->driver.minor_start; +#endif + +} + +static inline struct port *get_port_by_tty(struct tty_struct *tty) +{ + return &my_dev->port[get_index(tty)]; +} + +static inline dc_t *get_dc_by_tty(struct tty_struct *tty) +{ + return my_dev; +} + +/* TODO: */ +/* -Optimize */ +/* -Rewrite cleaner */ +//static void read_mem32(u32 *buf, u32 mem_addr_start, u32 size_bytes) { +static void read_mem32(u32 * buf, void __iomem * mem_addr_start, u32 size_bytes) +{ + u32 i = 0; + u32 *ptr = (__force u32 *) mem_addr_start; + u16 *buf16; + + /* 2 bytes */ + if (size_bytes == 2) { + buf16 = (u16 *) buf; + *buf16 = readw((void __iomem *)ptr); + return; + } + + while (i < size_bytes) { + if (size_bytes - i == 2) { + /* Handle 2 bytes in the end */ + buf16 = (u16 *) buf; + *(buf16) = readw((void __iomem *)ptr); + i += 2; + } else { + /* Read 4 bytes */ + *(buf) = readl((void __iomem *)ptr); + i += 4; + } + buf++; + ptr++; + } +} + +/* TODO: */ +/* - Rewrite cleaner */ +/* - merge with read_mem32() */ +//static void read_mem32_buf(u32 *buf, u32 mem_addr_start, u32 size_bytes) { +static void read_mem32_buf(u32 * buf, void __iomem * mem_addr_start, + u32 size_bytes) +{ +#ifdef __ARMEB__ + u32 i = 0; + u32 *ptr = (u32 *) mem_addr_start; + u16 *buf16; + + /* 2 bytes */ + if (size_bytes == 2) { + buf16 = (u16 *) buf; + *buf16 = __le16_to_cpu(readw(ptr)); + return; + } + + while (i < size_bytes) { + if (size_bytes - i == 2) { + /* Handle 2 bytes in the end */ + buf16 = (u16 *) buf; + *(buf16) = __le16_to_cpu(readw(ptr)); + i += 2; + } else { + /* Read 4 bytes */ + *(buf) = __le32_to_cpu(readl(ptr)); + i += 4; + } + buf++; + ptr++; + } +#else + read_mem32(buf, mem_addr_start, size_bytes); +#endif +} + +/* TODO: */ +/* -Optimize */ +/* -Rewrite cleaner */ +//static u32 write_mem32(u32 mem_addr_start, u32 *buf, u32 size_bytes) { +static u32 write_mem32(void __iomem * mem_addr_start, u32 * buf, u32 size_bytes) +{ + u32 i = 0; + u32 *ptr = (__force u32 *) mem_addr_start; + u16 *buf16; + + /* 2 bytes */ + if (size_bytes == 2) { + buf16 = (u16 *) buf; + writew(*buf16, (void __iomem *)ptr); + return 2; + } + + while (i < size_bytes) { + if (size_bytes - i == 2) { + /* 2 bytes */ + buf16 = (u16 *) buf; + writew(*buf16, (void __iomem *)ptr); + i += 2; + } else { + /* 4 bytes */ + writel(*buf, (void __iomem *)ptr); + i += 4; + } + buf++; + ptr++; + } + return size_bytes; +} + +/* Todo: */ +/* - Merge with write_mem32() */ +//static u32 write_mem32_buf(u32 mem_addr_start, u32 *buf, u32 size_bytes) { +static u32 write_mem32_buf(void __iomem * mem_addr_start, u32 * buf, + u32 size_bytes) +{ +#ifdef __ARMEB__ + u32 i = 0; + u32 *ptr = (u32 *) mem_addr_start; + u16 *buf16; + + /* 2 bytes */ + if (size_bytes == 2) { + buf16 = (u16 *) buf; + writew(__le16_to_cpu(*buf16), ptr); + return 2; + } + + while (i < size_bytes) { + if (size_bytes - i == 2) { + /* 2 bytes */ + buf16 = (u16 *) buf; + writew(__le16_to_cpu(*buf16), ptr); + i += 2; + } else { + /* 4 bytes */ + writel(__cpu_to_le32(*buf), ptr); + i += 4; + } + buf++; + ptr++; + } + return size_bytes; +#else + return write_mem32(mem_addr_start, buf, size_bytes); +#endif +} + +/* Setup pointers to different channels and also setup buffer sizes. */ +static void setup_memory(dc_t * dc) +{ + void __iomem *offset = dc->base_addr + dc->config_table.dl_start; + /* The length reported is including the length field of 4 bytes, hence subtract with 4. */ + u16 buff_offset = 4; + + /* Modem port dl configuration */ + dc->port[PORT_MDM].dl_addr[CH_A] = offset; + dc->port[PORT_MDM].dl_addr[CH_B] = (offset += + dc->config_table.dl_mdm_len1); + dc->port[PORT_MDM].dl_size[CH_A] = + dc->config_table.dl_mdm_len1 - buff_offset; + dc->port[PORT_MDM].dl_size[CH_B] = + dc->config_table.dl_mdm_len2 - buff_offset; + + /* Diag port dl configuration */ + dc->port[PORT_DIAG].dl_addr[CH_A] = (offset += + dc->config_table.dl_mdm_len2); + dc->port[PORT_DIAG].dl_size[CH_A] = + dc->config_table.dl_diag_len1 - buff_offset; + dc->port[PORT_DIAG].dl_addr[CH_B] = (offset += + dc->config_table.dl_diag_len1); + dc->port[PORT_DIAG].dl_size[CH_B] = + dc->config_table.dl_diag_len2 - buff_offset; + + /* App1 port dl configuration */ + dc->port[PORT_APP1].dl_addr[CH_A] = (offset += + dc->config_table.dl_diag_len2); + dc->port[PORT_APP1].dl_size[CH_A] = + dc->config_table.dl_app1_len - buff_offset; + + /* App2 port dl configuration */ + dc->port[PORT_APP2].dl_addr[CH_A] = (offset += + dc->config_table.dl_app1_len); + dc->port[PORT_APP2].dl_size[CH_A] = + dc->config_table.dl_app2_len - buff_offset; + + /* Ctrl dl configuration */ + dc->port[PORT_CTRL].dl_addr[CH_A] = (offset += + dc->config_table.dl_app2_len); + dc->port[PORT_CTRL].dl_size[CH_A] = + dc->config_table.dl_ctrl_len - buff_offset; + + /* Modem Port ul configuration */ + dc->port[PORT_MDM].ul_addr[CH_A] = (offset = + dc->base_addr + + dc->config_table.ul_start); + dc->port[PORT_MDM].ul_size[CH_A] = + dc->config_table.ul_mdm_len1 - buff_offset; + dc->port[PORT_MDM].ul_addr[CH_B] = (offset += + dc->config_table.ul_mdm_len1); + dc->port[PORT_MDM].ul_size[CH_B] = + dc->config_table.ul_mdm_len2 - buff_offset; + + /* Diag port ul configuration */ + dc->port[PORT_DIAG].ul_addr[CH_A] = (offset += + dc->config_table.ul_mdm_len2); + dc->port[PORT_DIAG].ul_size[CH_A] = + dc->config_table.ul_diag_len - buff_offset; + + /* App1 port ul configuration */ + dc->port[PORT_APP1].ul_addr[CH_A] = (offset += + dc->config_table.ul_diag_len); + dc->port[PORT_APP1].ul_size[CH_A] = + dc->config_table.ul_app1_len - buff_offset; + + /* App2 port ul configuration */ + dc->port[PORT_APP2].ul_addr[CH_A] = (offset += + dc->config_table.ul_app1_len); + dc->port[PORT_APP2].ul_size[CH_A] = + dc->config_table.ul_app2_len - buff_offset; + + /* Ctrl ul configuration */ + dc->port[PORT_CTRL].ul_addr[CH_A] = (offset += + dc->config_table.ul_app2_len); + dc->port[PORT_CTRL].ul_size[CH_A] = + dc->config_table.ul_ctrl_len - buff_offset; +// offset = dc->config_table.ul_start; +} + +/* Dump config table under initalization phase */ +#ifdef NOZOMI_DEBUG +static void dump_table(dc_t * dc) +{ + D3("signature: 0x%08X", dc->config_table.signature); + D3("version: 0x%04X", dc->config_table.version); + D3("product_information: 0x%04X", dc->config_table.product_information); + D3("toggle enabled: %d", dc->config_table.toggle.enabled); + D3("toggle up_mdm: %d", dc->config_table.toggle.mdm_ul); + D3("toggle dl_mdm: %d", dc->config_table.toggle.mdm_dl); + D3("toggle dl_dbg: %d", dc->config_table.toggle.diag_dl); + + D3("dl_start: 0x%04X", dc->config_table.dl_start); + D3("dl_mdm_len0: 0x%04X, %d", dc->config_table.dl_mdm_len1, + dc->config_table.dl_mdm_len1); + D3("dl_mdm_len1: 0x%04X, %d", dc->config_table.dl_mdm_len2, + dc->config_table.dl_mdm_len2); + D3("dl_diag_len0: 0x%04X, %d", dc->config_table.dl_diag_len1, + dc->config_table.dl_diag_len1); + D3("dl_diag_len1: 0x%04X, %d", dc->config_table.dl_diag_len2, + dc->config_table.dl_diag_len2); + D3("dl_app1_len: 0x%04X, %d", dc->config_table.dl_app1_len, + dc->config_table.dl_app1_len); + D3("dl_app2_len: 0x%04X, %d", dc->config_table.dl_app2_len, + dc->config_table.dl_app2_len); + D3("dl_ctrl_len: 0x%04X, %d", dc->config_table.dl_ctrl_len, + dc->config_table.dl_ctrl_len); + D3("ul_start: 0x%04X, %d", dc->config_table.ul_start, + dc->config_table.ul_start); + D3("ul_mdm_len[0]: 0x%04X, %d", dc->config_table.ul_mdm_len1, + dc->config_table.ul_mdm_len1); + D3("ul_mdm_len[1]: 0x%04X, %d", dc->config_table.ul_mdm_len2, + dc->config_table.ul_mdm_len2); + D3("ul_diag_len: 0x%04X, %d", dc->config_table.ul_diag_len, + dc->config_table.ul_diag_len); + D3("ul_app1_len: 0x%04X, %d", dc->config_table.ul_app1_len, + dc->config_table.ul_app1_len); + D3("ul_app2_len: 0x%04X, %d", dc->config_table.ul_app2_len, + dc->config_table.ul_app2_len); + D3("ul_ctrl_len: 0x%04X, %d", dc->config_table.ul_ctrl_len, + dc->config_table.ul_ctrl_len); +} +#endif + +/* Read configuration table from card under intalization phase */ +/* Returns 1 if ok, else 0 */ +static int nozomi_read_config_table(dc_t * dc) +{ + + GET_MEM(&dc->config_table, dc->base_addr + 0, sizeof(config_table_t)); + + /* D1( "0x%08X == 0x%08X ", dc->config_table.signature, CONFIG_MAGIC); */ + + if (dc->config_table.signature != CONFIG_MAGIC) { + dev_err(&dc->pdev->dev, "ConfigTable Bad! 0x%08X != 0x%08X\n", + dc->config_table.signature, CONFIG_MAGIC); + return 0; + } + + if ((dc->config_table.version == 0) + || (dc->config_table.toggle.enabled == TOGGLE_VALID)) { + int i; + D1("Second phase, configuring card"); + + setup_memory(dc); + + dc->port[PORT_MDM].toggle_ul = dc->config_table.toggle.mdm_ul; + dc->port[PORT_MDM].toggle_dl = dc->config_table.toggle.mdm_dl; + dc->port[PORT_DIAG].toggle_dl = dc->config_table.toggle.diag_dl; + D1("toggle ports: MDM UL:%d MDM DL:%d, DIAG DL:%d", + dc->port[PORT_MDM].toggle_ul, + dc->port[PORT_MDM].toggle_dl, dc->port[PORT_DIAG].toggle_dl); + +#ifdef NOZOMI_DEBUG + dump_table(dc); +#endif + for (i = PORT_MDM; i < MAX_PORT; i++) { + dc->port[i].fifo_ul = + kfifo_alloc(FIFO_BUFFER_SIZE_UL, GFP_ATOMIC, NULL); + memset(&dc->port[i].ctrl_dl, 0, sizeof(ctrl_dl_t)); + memset(&dc->port[i].ctrl_ul, 0, sizeof(ctrl_ul_t)); + } + + /* Enable control channel */ + SET_IER(CTRL_DL, CTRL_DL); + + dev_info(&dc->pdev->dev, "Initialization OK!\n"); + return 1; + } + + if ((dc->config_table.version > 0) + && (dc->config_table.toggle.enabled != TOGGLE_VALID)) { + u32 offset = 0; + D1("First phase: pushing upload buffers, clearing download"); + + dev_info(&dc->pdev->dev, "Version of card: %d\n", + dc->config_table.version); + + /* Here we should disable all I/O over F32. */ + setup_memory(dc); + + /* We should send ALL channel pair tokens back along with reset token */ + + /* push upload modem buffers */ + SET_MEM(dc->port[PORT_MDM].ul_addr[CH_A], &offset, 4); + SET_MEM(dc->port[PORT_MDM].ul_addr[CH_B], &offset, 4); + + SET_FCR(MDM_UL | DIAG_DL | MDM_DL); + + D1("First phase done"); + } + + return 1; +} + +/* Enable uplink interrupts */ +static void enable_transmit_ul(enum port_type port, dc_t * dc) +{ + + switch (port) { + case PORT_MDM: + SET_IER(MDM_UL, MDM_UL); + break; + case PORT_DIAG: + SET_IER(DIAG_UL, DIAG_UL); + break; + case PORT_APP1: + SET_IER(APP1_UL, APP1_UL); + break; + case PORT_APP2: + SET_IER(APP2_UL, APP2_UL); + break; + case PORT_CTRL: + SET_IER(CTRL_UL, CTRL_UL); + break; + default: + dev_err(&dc->pdev->dev, "Called with wrong port?\n"); + break; + }; +} + +/* Disable uplink interrupts */ +static void disable_transmit_ul(enum port_type port, dc_t * dc) +{ + switch (port) { + case PORT_MDM: + SET_IER(0, MDM_UL); + break; + case PORT_DIAG: + SET_IER(0, DIAG_UL); + break; + case PORT_APP1: + SET_IER(0, APP1_UL); + break; + case PORT_APP2: + SET_IER(0, APP2_UL); + break; + case PORT_CTRL: + SET_IER(0, CTRL_UL); + break; + default: + dev_err(&dc->pdev->dev, "Called with wrong port?\n"); + break; + }; +} + +/* Enable downlink interrupts */ +static void enable_transmit_dl(enum port_type port, dc_t * dc) +{ + switch (port) { + case PORT_MDM: + SET_IER(MDM_DL, MDM_DL); + break; + case PORT_DIAG: + SET_IER(DIAG_DL, DIAG_DL); + break; + case PORT_APP1: + SET_IER(APP1_DL, APP1_DL); + break; + case PORT_APP2: + SET_IER(APP2_DL, APP2_DL); + break; + case PORT_CTRL: + SET_IER(CTRL_DL, CTRL_DL); + break; + default: + dev_err(&dc->pdev->dev, "Called with wrong port?\n"); + break; + }; +} + +/* Disable downlink interrupts */ +static void disable_transmit_dl(enum port_type port, dc_t * dc) +{ + switch (port) { + case PORT_MDM: + SET_IER(0, MDM_DL); + break; + case PORT_DIAG: + SET_IER(0, DIAG_DL); + break; + case PORT_APP1: + SET_IER(0, APP1_DL); + break; + case PORT_APP2: + SET_IER(0, APP2_DL); + break; + case PORT_CTRL: + SET_IER(0, CTRL_DL); + break; + default: + dev_err(&dc->pdev->dev, "Called with wrong port?\n"); + break; + }; +} + +/* Return 1 - send buffer to card and ack. */ +/* Return 0 - don't ack, don't send buffer to card. */ +static int send_data(enum port_type index, dc_t * dc) +{ + u32 size = 0; + struct port *port = &dc->port[index]; + u8 toggle = port->toggle_ul; + void __iomem *addr = port->ul_addr[toggle]; + u32 ul_size = port->ul_size[toggle]; + struct tty_struct *tty = port->tty; + + if (index >= NTTY_TTY_MINORS) { + dev_err(&dc->pdev->dev, "Called with wrong index?\n"); + return 0; + } + + /* Get data from tty and place in buf for now */ + size = + __kfifo_get(port->fifo_ul, dc->send_buf, + ul_size < SEND_BUF_MAX ? ul_size : SEND_BUF_MAX); + + if (size == 0) { + D4("No more data to send, disable link:"); + return 0; + } + + port->tx_data += size; + + /* DUMP(buf, size); */ + + /* Write length + data */ + SET_MEM(addr, &size, 4); + SET_MEM_BUF(addr + 4, dc->send_buf, size); + + if (port->tty) { + if ((tty->flags & (1 << TTY_DO_WRITE_WAKEUP)) + && tty->ldisc.write_wakeup) { + tty->ldisc.write_wakeup(tty); + } + wake_up_interruptible(&tty->write_wait); + } + + return 1; +} + +/* If all data has been read, return 1, else 0 */ +static int receive_data(enum port_type index, dc_t * dc) +{ + u8 buf[RECEIVE_BUF_MAX] = { 0 }; + int size; + u32 offset = 4; + struct port *port = &dc->port[index]; + u8 toggle = port->toggle_dl; + void __iomem *addr = port->dl_addr[toggle]; + struct tty_struct *tty = port->tty; + int i; + + if (!tty) { + D1("tty not open for port: %d?", index); + return 1; + } + + GET_MEM(&size, addr, 4); + /* D1( "%d bytes port: %d", size, index); */ + + if (test_bit(TTY_THROTTLED, &tty->flags)) { + D1("No room in tty, don't read data, don't ack interrupt, disable interrupt"); + + /* disable interrupt in downlink... */ + disable_transmit_dl(index, dc); +#ifdef KERNEL_2_4 + schedule_task(&dc->tty_flip_queue); +#endif + return 0; + } + + if (size == 0) { + dev_err(&dc->pdev->dev, "size == 0?\n"); + return 1; + } + + while (size > 0) { + GET_MEM_BUF(buf, addr + offset, 4); + + i = 0; + while (i < 4 && size > 0) { +#ifdef KERNEL_2_6_14 + if (tty_buffer_request_room(tty, 1) < 1) +#else + if (tty->flip.count >= TTY_FLIPBUF_SIZE) //pre 2.6.14 kernels*/ +#endif + { + tty_flip_buffer_push(tty); + } + tty_insert_flip_char(tty, buf[i], TTY_NORMAL); + port->rx_data++; + i++; + size--; + } + + offset += 4; + } + + tty_flip_buffer_push(tty); + + return 1; +} + +/* Debug for interrupts */ +#ifdef NOZOMI_DEBUG +static char *interrupt2str(u16 interrupt) +{ + static char buf[TMP_BUF_MAX]; + char *p = buf; + + interrupt & MDM_DL1 ? p += snprintf(p, TMP_BUF_MAX, "MDM_DL1 ") : 0; + interrupt & MDM_DL2 ? p += snprintf(p, TMP_BUF_MAX, "MDM_DL2 ") : 0; + + interrupt & MDM_UL1 ? p += snprintf(p, TMP_BUF_MAX, "MDM_UL1 ") : 0; + interrupt & MDM_UL2 ? p += snprintf(p, TMP_BUF_MAX, "MDM_UL2 ") : 0; + + interrupt & DIAG_DL1 ? p += snprintf(p, TMP_BUF_MAX, "DIAG_DL1 ") : 0; + interrupt & DIAG_DL2 ? p += snprintf(p, TMP_BUF_MAX, "DIAG_DL2 ") : 0; + + interrupt & DIAG_UL ? p += snprintf(p, TMP_BUF_MAX, "DIAG_UL ") : 0; + + interrupt & APP1_DL ? p += snprintf(p, TMP_BUF_MAX, "APP1_DL ") : 0; + interrupt & APP2_DL ? p += snprintf(p, TMP_BUF_MAX, "APP2_DL ") : 0; + + interrupt & APP1_UL ? p += snprintf(p, TMP_BUF_MAX, "APP1_UL ") : 0; + interrupt & APP2_UL ? p += snprintf(p, TMP_BUF_MAX, "APP2_UL ") : 0; + + interrupt & CTRL_DL ? p += snprintf(p, TMP_BUF_MAX, "CTRL_DL ") : 0; + interrupt & CTRL_UL ? p += snprintf(p, TMP_BUF_MAX, "CTRL_UL ") : 0; + + interrupt & RESET ? p += snprintf(p, TMP_BUF_MAX, "RESET ") : 0; + + return buf; +} +#endif + +/* Receive flow control */ +/* Return 1 - If ok, else 0 */ +static int receive_flow_control(dc_t * dc, irq_t * m) +{ + enum port_type port = PORT_MDM; + ctrl_dl_t ctrl_dl; + ctrl_dl_t old_ctrl; + u16 enable_ier = 0; + + GET_MEM(&ctrl_dl, dc->port[PORT_CTRL].dl_addr[CH_A], 2); + + switch (ctrl_dl.port) { + case CTRL_CMD: + D1("The Base Band sends this value as a response to a request for IMSI detach sent" " over the control channel uplink (see section 7.6.1)."); + break; + case CTRL_MDM: + port = PORT_MDM; + enable_ier = MDM_DL; + break; + case CTRL_DIAG: + port = PORT_DIAG; + enable_ier = DIAG_DL; + break; + case CTRL_APP1: + port = PORT_APP1; + enable_ier = APP1_DL; + break; + case CTRL_APP2: + port = PORT_APP2; + enable_ier = APP2_DL; + break; + default: + dev_err(&dc->pdev->dev, + "ERROR: flow control received for non-existing port\n"); + return 0; + }; + + D1("0x%04X->0x%04X", *((u16 *) & dc->port[port].ctrl_dl), + *((u16 *) & ctrl_dl)); + + old_ctrl = dc->port[port].ctrl_dl; + dc->port[port].ctrl_dl = ctrl_dl; + + if (old_ctrl.CTS == 1 && ctrl_dl.CTS == 0) { + D1("Disable interrupt (0x%04X) on port: %d", enable_ier, port); + disable_transmit_ul(port, dc); + + } else if (old_ctrl.CTS == 0 && ctrl_dl.CTS == 1) { + + if (__kfifo_len(dc->port[port].fifo_ul)) { + D1("Enable interrupt (0x%04X) on port: %d", enable_ier, + port); + D1("Data in buffer [%d], enable transmit! ", + __kfifo_len(dc->port[port].fifo_ul)); + enable_transmit_ul(port, dc); + } else { + D1("No data in buffer..."); + } + } + + if (*(u16 *) & old_ctrl == *(u16 *) & ctrl_dl) { + D1(" No change in mctrl"); + return 1; + } + /* Update statistics */ + if (old_ctrl.CTS != ctrl_dl.CTS) { + dc->port[port].tty_icount.cts++; + } + if (old_ctrl.DSR != ctrl_dl.DSR) { + dc->port[port].tty_icount.dsr++; + } + if (old_ctrl.RI != ctrl_dl.RI) { + dc->port[port].tty_icount.rng++; + } + if (old_ctrl.DCD != ctrl_dl.DCD) { + dc->port[port].tty_icount.dcd++; + } + D1("port: %d DCD(%d), CTS(%d), RI(%d), DSR(%d)", + port, + dc->port[port].tty_icount.dcd, dc->port[port].tty_icount.cts, + dc->port[port].tty_icount.rng, dc->port[port].tty_icount.dsr); + + return 1; +} + +/* TODO: */ +/* - return enum ctrl_port_type */ +static u8 port2ctrl(enum port_type port, dc_t * dc) +{ + switch (port) { + case PORT_MDM: + return CTRL_MDM; + case PORT_DIAG: + return CTRL_DIAG; + case PORT_APP1: + return CTRL_APP1; + case PORT_APP2: + return CTRL_APP2; + default: + dev_err(&dc->pdev->dev, + "ERROR: send flow control received for non-existing port\n"); + }; + return -1; +} + +/* Send flow control, can only update one channel at a time */ +/* Return 0 - If we have updated all flow control */ +/* Return 1 - If we need to update more flow control, ack current enable more */ +static int send_flow_control(dc_t * dc) +{ + u32 i, more_flow_control_to_be_updated = 0; + u16 *ctrl; + + for (i = PORT_MDM; i < MAX_PORT; i++) { + if (dc->port[i].update_flow_control) { + if (more_flow_control_to_be_updated) { + /* We have more flow control to be updated */ + return 1; + } + dc->port[i].ctrl_ul.port = port2ctrl(i, dc); + ctrl = (u16 *) & dc->port[i].ctrl_ul; + /* D1( "sending flow control 0x%04X for port %d, %d", (u16) *ctrl, i, dc->port[i].ctrl_ul.port ); */ + SET_MEM(dc->port[PORT_CTRL].ul_addr[0], (u32 *) ctrl, + 2); + dc->port[i].update_flow_control = 0; + more_flow_control_to_be_updated = 1; + } + } + return 0; +} + +/* Handle donlink data, ports that are handled are modem and diagnostics */ +/* Return 1 - ok */ +/* Return 0 - toggle fields are out of sync */ +static int handle_data_dl(dc_t * dc, irq_t * m, enum port_type port, + u8 * toggle, u16 mask1, u16 mask2) +{ + + if (*toggle == 0 && m->read_iir & mask1) { + if (receive_data(port, dc)) { + SET_FCR(mask1); + *toggle = !(*toggle); + } + + if (m->read_iir & mask2) { + if (receive_data(port, dc)) { + SET_FCR(mask2); + *toggle = !(*toggle); + } + } + } else if (*toggle == 1 && m->read_iir & mask2) { + if (receive_data(port, dc)) { + SET_FCR(mask2); + *toggle = !(*toggle); + } + + if (m->read_iir & mask1) { + if (receive_data(port, dc)) { + SET_FCR(mask1); + *toggle = !(*toggle); + } + } + } else { + ERR("port out of sync!, toggle:%d", *toggle); + return 0; + } + return 1; +} + +/* Handle uplink data, this is currently for the modem port */ +/* Return 1 - ok */ +/* Return 0 - toggle field are out of sync */ +static int handle_data_ul(dc_t * dc, irq_t * m, enum port_type port) +{ + + u8 *toggle = &(dc->port[port].toggle_ul); + + if (*toggle == 0 && m->read_iir & MDM_UL1) { + SET_IER(0, MDM_UL); + if (send_data(port, dc)) { + SET_FCR(MDM_UL1); + SET_IER(MDM_UL, MDM_UL); + *toggle = !*toggle; + } + + if (m->read_iir & MDM_UL2) { + SET_IER(0, MDM_UL); + if (send_data(port, dc)) { + SET_FCR(MDM_UL2); + SET_IER(MDM_UL, MDM_UL); + *toggle = !*toggle; + } + } + + } else if (*toggle == 1 && m->read_iir & MDM_UL2) { + SET_IER(0, MDM_UL); + if (send_data(port, dc)) { + SET_FCR(MDM_UL2); + SET_IER(MDM_UL, MDM_UL); + *toggle = !*toggle; + } + + if (m->read_iir & MDM_UL1) { + SET_IER(0, MDM_UL); + if (send_data(port, dc)) { + SET_FCR(MDM_UL1); + SET_IER(MDM_UL, MDM_UL); + *toggle = !*toggle; + } + } + } else { + SET_FCR(m->read_iir & MDM_UL); + ERR("port out of sync!"); + return 0; + } + return 1; +} + +static irqreturn_t interrupt_handler(int irq, void *dev_id, + struct pt_regs *regs) +{ + dc_t *dc = NULL; + irq_t *m = &my_irq; + + if (my_dev && my_dev->pdev != dev_id) { + return IRQ_NONE; + } + + if (!(dc = get_dc_by_pdev(dev_id))) { + ERR("Could not find device context from pci_dev: %Xu", + (u32) dev_id); + return IRQ_NONE; + } + + GET_IIR(m->read_iir); + + /* Just handle interrupt enabled in IER (by masking with dc->ier_last_written) */ + m->read_iir &= dc->ier_last_written; + + if (m->read_iir == 0) { + return IRQ_NONE; + } + + if (dc == NULL) { + ERR("ERROR!!"); + return IRQ_NONE; + } + + spin_lock(&dc->spin_mutex); + + D4("%s irq:0x%04X, prev:0x%04X", interrupt2str(m->read_iir), + m->read_iir, dc->ier_last_written); + + if (m->read_iir & RESET) { + if (!nozomi_read_config_table(dc)) { + SET_IER(0, 0xFFFF); + ERR("ERR: Could not read status from card, we should disable interface"); + } else { + SET_FCR(RESET); + } + goto exit_handler; /* No more useful info if this was the reset interrupt. */ + } + if (m->read_iir & CTRL_UL) { + D1("CTRL_UL"); + SET_IER(0, CTRL_UL); + if (send_flow_control(dc)) { + SET_FCR(CTRL_UL); + SET_IER(CTRL_UL, CTRL_UL); + } + } + if (m->read_iir & CTRL_DL) { + receive_flow_control(dc, m); + SET_FCR(CTRL_DL); + } + if (m->read_iir & MDM_DL) { + if (! + (handle_data_dl + (dc, m, PORT_MDM, &(dc->port[PORT_MDM].toggle_dl), MDM_DL1, + MDM_DL2))) { + ERR("MDM_DL out of sync!"); + goto exit_handler; + } + } + if (m->read_iir & MDM_UL) { + if (!handle_data_ul(dc, m, PORT_MDM)) { + ERR("MDM_UL out of sync!"); + goto exit_handler; + } + } + if (m->read_iir & DIAG_DL) { + if (! + (handle_data_dl + (dc, m, PORT_DIAG, &(dc->port[PORT_DIAG].toggle_dl), + DIAG_DL1, DIAG_DL2))) { + ERR("DIAG_DL out of sync!"); + goto exit_handler; + } + } + if (m->read_iir & DIAG_UL) { + SET_IER(0, DIAG_UL); + if (send_data(PORT_DIAG, dc)) { + SET_FCR(DIAG_UL); + SET_IER(DIAG_UL, DIAG_UL); + } + } + if (m->read_iir & APP1_DL) { + if (receive_data(PORT_APP1, dc)) { + SET_FCR(APP1_DL); + } + } + if (m->read_iir & APP1_UL) { + SET_IER(0, APP1_UL); + if (send_data(PORT_APP1, dc)) { + SET_FCR(APP1_UL); + SET_IER(APP1_UL, APP1_UL); + } + } + if (m->read_iir & APP2_DL) { + if (receive_data(PORT_APP2, dc)) { + SET_FCR(APP2_DL); + } + } + if (m->read_iir & APP2_UL) { + SET_IER(0, APP2_UL); + if (send_data(PORT_APP2, dc)) { + SET_FCR(APP2_UL); + SET_IER(APP2_UL, APP2_UL); + } + } + + exit_handler: + spin_unlock(&dc->spin_mutex); + return IRQ_HANDLED; +} + +/* Request a shared IRQ from system */ +static int nozomi_setup_interrupt(struct pci_dev *pdev) +{ + + int rval = 0; + + if ((rval = + request_irq(pdev->irq, &interrupt_handler, SA_SHIRQ, NOZOMI_NAME, + pdev))) { + ERR("Cannot open because IRQ %d is already in use.", pdev->irq); + return rval; + } + + return rval; +} + +static void nozomi_get_card_type(dc_t * dc) +{ + int i; + u32 size = 0; + + for (i = 0; i < 6; i++) + size += pci_resource_len(dc->pdev, i); + /* Assume card type F32_8 if no match */ + dc->card_type = size == 2048 ? F32_2 : F32_8; + dev_info(&dc->pdev->dev, "Card type is: %d\n", dc->card_type); +} + +static void nozomi_setup_private_data(dc_t * dc) +{ + void __iomem *offset = dc->base_addr + dc->card_type / 2; + int i; + + dc->REG_FCR = (void __iomem *)(offset + R_FCR); + dc->REG_IIR = (void __iomem *)(offset + R_IIR); + dc->REG_IER = (void __iomem *)(offset + R_IER); + dc->ier_last_written = 0; + dc->closing = 0; + dc->port[PORT_MDM].token_dl = MDM_DL; + dc->port[PORT_DIAG].token_dl = DIAG_DL; + dc->port[PORT_APP1].token_dl = APP1_DL; + dc->port[PORT_APP2].token_dl = APP2_DL; + + for (i = PORT_MDM; i < MAX_PORT; i++) { + dc->port[i].rx_data = dc->port[i].tx_data = 0; + dc->port[i].tty_dont_flip = 0; + } +} + +static void tty_flip_queue_function(void *tmp_dc) +{ + dc_t *dc = (dc_t *) tmp_dc; + int i; + unsigned long flags; + + /* Enable interrupt for that port */ + for (i = 0; i < MAX_PORT; i++) { + if (dc->port[i].tty_dont_flip) { + D6("Enable for port: %d", i); + dc->port[i].tty_dont_flip = 0; + spin_lock_irqsave(&dc->spin_mutex, flags); + enable_transmit_dl(dc->port[i].tty_index, dc); + spin_unlock_irqrestore(&dc->spin_mutex, flags); + } + } +} + +static int read_proc_card_type(char *buf, char **start, off_t offset, int len) +{ + dc_t *dc = get_dc_by_index(0); + len = 0; + + len += sprintf(buf + len, "%d\n", dc->card_type); + return len; +} + +static int read_proc_open_ttys(char *buf, char **start, off_t offset, int len) +{ + dc_t *dc = get_dc_by_index(0); + len = 0; + + len += sprintf(buf + len, "%d\n", dc->open_ttys); + return len; +} + +static int read_proc_version(char *buf, char **start, off_t offset, int len) +{ + len = 0; + + len += sprintf(buf + len, "%s\n", VERSION_STRING); + return len; +} + +static int read_proc_rtx(char *buf, char **start, off_t offset, int len) +{ + dc_t *dc = get_dc_by_index(0); + int i; + + len = 0; + + for (i = PORT_MDM; i < MAX_PORT; i++) { + len += + sprintf(buf + len, "noz%d rx: %d, tx: %d\n", i, + dc->port[i].rx_data, dc->port[i].tx_data); + } + return len; +} + +static void make_proc_dirs(void) +{ + dc_t *dc = get_dc_by_index(0); + dc->proc_entry = proc_mkdir("nozomi", &proc_root); + + /* Register the read_proc */ + if (!create_proc_info_entry + ("card_type", 0, dc->proc_entry, read_proc_card_type)) { + ERR("ERROR: failed to register read_procmem"); + } + if (!create_proc_info_entry + ("open_ttys", 0, dc->proc_entry, read_proc_open_ttys)) { + ERR("ERROR: failed to register read_procmem"); + } + if (!create_proc_info_entry("rtx", 0, dc->proc_entry, read_proc_rtx)) { + ERR("ERROR: failed to register read_procmem"); + } + if (!create_proc_info_entry + ("version", 0, dc->proc_entry, read_proc_version)) { + ERR("ERROR: failed to register read_procmem"); + } +} + +static void remove_proc_dirs(void) +{ + dc_t *dc = get_dc_by_index(0); + + remove_proc_entry("card_type", dc->proc_entry); + remove_proc_entry("open_ttys", dc->proc_entry); + remove_proc_entry("rtx", dc->proc_entry); + remove_proc_entry("version", dc->proc_entry); + remove_proc_entry("nozomi", &proc_root); +} + +/* Allocate memory for one device */ +static int __devinit nozomi_card_init(struct pci_dev *pdev, + const struct pci_device_id *ent) +{ + int ret = -EIO; + dc_t *dc = NULL; + + cards_found++; + dev_info(&pdev->dev, "Init, cards_found: %d\n", cards_found); + + if (!(my_dev = kmalloc(sizeof(dc_t), GFP_KERNEL))) { + D1("Could not allocate memory"); + return -EIO; + } + + memset(my_dev, 0, sizeof(dc_t)); + + if (cards_found > 1) { + dev_err(&pdev->dev, "This driver only supports 1 device\n"); + return -ENODEV; + } + + my_dev->pdev = pdev; + dc = my_dev; + + /* Find out what card type it is */ + nozomi_get_card_type(dc); + + if (pci_enable_device(dc->pdev)) { + dev_err(&pdev->dev, "Not possible to enable PCI Device\n"); + return -ENODEV; + } + dc->base_addr = (void *)pci_resource_start(dc->pdev, 0); + if (dc->base_addr == 0x0000) { + dev_err(&pdev->dev, "No I/O-Address for card detected\n"); + ret = -ENODEV; + goto err_disable_device; + } + dc->base_addr = (void *)ioremap((int)dc->base_addr, dc->card_type); + if (!dc->base_addr) { + dev_err(&pdev->dev, "No I/O-Address for card detected\n"); + ret = -ENODEV; + goto err_disable_device; + } + + dc->open_ttys = 0; + + nozomi_setup_private_data(dc); + + if (pci_request_regions(dc->pdev, NOZOMI_NAME)) { + dev_err(&pdev->dev, "I/O address 0x%04x already in use\n", + (int) /* nozomi_private.io_addr */ 0); + ret = -EIO; + goto err_disable_regions; + } + + dc->send_buf = kmalloc(SEND_BUF_MAX, GFP_KERNEL); + if (!dc->send_buf) { + dev_err(&pdev->dev, "Could not allocate send buffer?\n"); + goto err_disable_regions; + } + + /* Disable all interrupts */ + SET_IER(0, 0xFFFF); + + /* Setup interrupt handler */ + if (nozomi_setup_interrupt(dc->pdev)) { + ret = -EIO; + goto err_disable_regions; + } + + D1("base_addr: 0x%08X", dc->base_addr); +#ifdef KERNEL_2_4 + dc->tty_flip_queue.list.next = NULL; + dc->tty_flip_queue.list.prev = NULL; + dc->tty_flip_queue.sync = 0; + dc->tty_flip_queue.data = dc; + dc->tty_flip_queue.routine = tty_flip_queue_function; +#endif +#ifdef KERNEL_2_6 + if (!(dc->tty_flip_wq = create_singlethread_workqueue(NOZOMI_NAME))) { + ERR("Could not create workqueue?"); + BUG_ON(!dc->tty_flip_wq); + return -ENOMEM; + } + INIT_WORK(&dc->tty_flip_wq_struct, tty_flip_queue_function, dc); +#endif + spin_lock_init(&dc->spin_mutex); + make_proc_dirs(); + ntty_tty_init(dc); + /* Enable RESET interrupt. */ + SET_IER(RESET, 0xFFFF); + return 0; + + err_disable_regions: + pci_release_regions(pdev); + iounmap(dc->base_addr); + dc->base_addr = NULL; + + err_disable_device: + pci_disable_device(pdev); + kfree(my_dev); + return ret; +} + +static void tty_do_close(dc_t * dc, struct port *port) +{ + + unsigned long flags; + + if (down_interruptible(&port->tty_sem)) { + return; + } + if (port->tty_open_count) { + dc->open_ttys--; + port->tty_open_count--; + #ifdef KERNEL_2_4 + MOD_DEC_USE_COUNT; + #endif + if (port->tty_open_count == 0) { + D1("close: %d", port->token_dl); + spin_lock_irqsave(&dc->spin_mutex, flags); + SET_IER(0, port->token_dl); + spin_unlock_irqrestore(&dc->spin_mutex, flags); + } + } + up(&port->tty_sem); +} + +static void __devexit tty_exit(void) +{ + dc_t *dc = my_dev; + int i; + + D1(" "); + for (i = 0; i < NTTY_TTY_MINORS; i++) { + while (dc->port[i].tty_open_count) + tty_do_close(dc, &dc->port[i]); + dc->port[i].tty = NULL; + } +#ifdef KERNEL_2_6 + for (i = 0; i < NTTY_TTY_MINORS; ++i){ + D1("Unregistering device"); + tty_unregister_device(dc->tty_driver, i); + } +#endif + D1("Unregistering driver"); + tty_unregister_driver(dc->tty_driver); + put_tty_driver(dc->tty_driver); +} + +/* Deallocate memory for one device */ +static void __devexit nozomi_card_exit(struct pci_dev *pdev) +{ + int i; + ctrl_ul_t ctrl; + dc_t *dc = get_dc_by_pdev(pdev); + + /* Disable all interrupts */ + SET_IER(0, 0xFFFF); + + /* Send 0x0001, command card to resend the reset token. */ + /* This is to get the reset when the module is reloaded. */ + ctrl.port = 0x00; + ctrl.reserved = 0; + ctrl.RTS = 0; + ctrl.DTR = 1; + D1("sending flow control 0x%04X", *((u16 *) & ctrl)); + + /* Setup dc->reg addresses to we can use defines here */ + nozomi_setup_private_data(dc); + SET_MEM(dc->port[PORT_CTRL].ul_addr[0], (u32 *) & ctrl, 2); + SET_FCR(CTRL_UL); /* push the token to the card. */ + + D1("pci_release_regions"); + pci_release_regions(pdev); + + if (dc->base_addr) + iounmap(dc->base_addr); + + D1("pci_disable_device"); + pci_disable_device(pdev); + + free_irq(pdev->irq, pdev); + + for (i = PORT_MDM; i < MAX_PORT; i++) { + kfree(dc->port[i].fifo_ul); + } + + kfree(dc->send_buf); + + tty_exit(); + + remove_proc_dirs(); + +#ifdef KERNEL_2_6 + destroy_workqueue(dc->tty_flip_wq); +#endif + if (my_dev) { + kfree(my_dev); + } + + cards_found--; +} + +static void set_rts(int index, int rts) +{ + dc_t *dc = get_dc_by_index(index); + dc->port[index].ctrl_ul.RTS = rts; + dc->port[index].update_flow_control = 1; + enable_transmit_ul(PORT_CTRL, dc); +} + +static void set_dtr(int index, int dtr) +{ + dc_t *dc = get_dc_by_index(index); + D1("SETTING DTR index: %d, dtr: %d", index, dtr); + dc->port[index].ctrl_ul.DTR = dtr; + dc->port[index].update_flow_control = 1; + enable_transmit_ul(PORT_CTRL, dc); +} + +/* --------------------------------------------------------------------------------------------------- + TTY code + ---------------------------------------------------------------------------------------------------*/ + +/* Called when the userspace process opens the tty, /dev/noz*. */ +static int ntty_open(struct tty_struct *tty, struct file *file) +{ + + s32 index = get_index(tty); + struct port *port = get_port_by_tty(tty); + dc_t *dc = get_dc_by_tty(tty); + unsigned long flags; + + if (down_interruptible(&port->tty_sem)) { + return -ERESTARTSYS; + } + + tty->low_latency = 1; + tty->driver_data = port; + port->tty = tty; + port->tty_index = index; + port->tty_open_count++; + dc->open_ttys++; +#ifdef KERNEL_2_4 + MOD_INC_USE_COUNT; +#endif + /* Enable interrupt downlink for channel */ + if (port->tty_open_count == 1) { + port->rx_data = port->tx_data = 0; + D1("open: %d", port->token_dl); + spin_lock_irqsave(&dc->spin_mutex, flags); + SET_IER(port->token_dl, port->token_dl); + spin_unlock_irqrestore(&dc->spin_mutex, flags); + } + + up(&port->tty_sem); + return 0; +} + +/* Called when the userspace process close the tty, /dev/noz*. */ +static void ntty_close(struct tty_struct *tty, struct file *file) +{ + dc_t *dc = get_dc_by_tty(tty); + tty_do_close(dc, (struct port *)tty->driver_data); +} + +/* called when the userspace process writes to the tty (/dev/noz*). */ +/* Data is inserted into a fifo, which is then read and transfered to the modem. */ +#ifdef KERNEL_2_6 +static int ntty_write(struct tty_struct *tty, const u8 *buffer, + int count) +{ +#else +static s32 ntty_write(struct tty_struct *tty, s32 from_user, const u8 * buffer, + s32 count) +{ +#endif + int rval = -EINVAL; + dc_t *dc = get_dc_by_tty(tty); + struct port *port = (struct port *)tty->driver_data; + unsigned long flags; + + /* D1( "WRITEx: %d, index = %d", count, index); */ + + if (!port) { + return -ENODEV; + } + + if (down_trylock(&port->tty_sem)) { // must test lock as tty layer wraps calls to this function with BKL + ERR("Would have deadlocked - return ERESTARTSYS"); + return -ERESTARTSYS; + } + + if (!port->tty_open_count) { + D1(" "); + goto exit; + } +#ifdef KERNEL_2_4 + if (from_user) { + rval = + __kfifo_put_user(port->fifo_ul, (unsigned char *)buffer, + count); + } else { + rval = + __kfifo_put(port->fifo_ul, (unsigned char *)buffer, count); + } +#else + rval = __kfifo_put(port->fifo_ul, (unsigned char *)buffer, count); +#endif + + /* notify card */ + if (dc == NULL) { + D1("No device context?"); + goto exit; + } + + spin_lock_irqsave(&dc->spin_mutex, flags); + // CTS is only valid on the modem channel + if (port == &(dc->port[PORT_MDM])) { + if (port->ctrl_dl.CTS) { + D4("Enable interrupt"); + enable_transmit_ul(port->tty_index, dc); + } else { + ERR("CTS not active on modem port?"); + } + } else { + enable_transmit_ul(port->tty_index, dc); + } + spin_unlock_irqrestore(&dc->spin_mutex, flags); + + exit: + up(&port->tty_sem); + return rval; +} + +/* Calculate how much is left in device */ +/* This method is called by the upper tty layer. */ +/* #according to sources N_TTY.c it expects a value >= 0 and does not check for negative values. */ +static int ntty_write_room(struct tty_struct *tty) +{ + struct port *port = (struct port *)tty->driver_data; + int room = 0; + if (!port) { + return 0; + } + if (down_trylock(&port->tty_sem)) { + return 0; + } + if (port->tty_open_count) { + room = port->fifo_ul->size - __kfifo_len(port->fifo_ul); + } + up(&port->tty_sem); + return room; +} + +/* Sets termios flags, called by the tty layer. */ +static void ntty_set_termios(struct tty_struct *tty, + struct termios *old_termios) +{ + unsigned int cflag; + + cflag = tty->termios->c_cflag; + + if (old_termios) { + if ((cflag == old_termios->c_cflag) && + (RELEVANT_IFLAG(tty->termios->c_iflag) == + RELEVANT_IFLAG(old_termios->c_iflag))) { + D1(" - nothing to change..."); + goto exit_termios; + } + } + + /* get the byte size */ + switch (cflag & CSIZE) { + case CS5: + D1(" - data bits = 5"); + break; + case CS6: + D1(" - data bits = 6"); + break; + case CS7: + D1(" - data bits = 7"); + break; + default: + case CS8: + D1(" - data bits = 8"); + break; + } + + /* determine the parity */ + if (cflag & PARENB) { + if (cflag & PARODD) { + D1(" - parity = odd"); + } else { + D1(" - parity = even"); + } + } else { + D1(" - parity = none"); + } + + /* figure out the stop bits requested */ + if (cflag & CSTOPB) { + D1(" - stop bits = 2"); + } else { + D1(" - stop bits = 1"); + } + + /* figure out the hardware flow control settings */ + if (cflag & CRTSCTS) { + D1(" - RTS/CTS is enabled"); + } else { + D1(" - RTS/CTS is disabled"); + } + + /* determine software flow control */ + /* if we are implementing XON/XOFF, set the start and + * stop character in the device */ + if (I_IXOFF(tty) || I_IXON(tty)) { +#ifdef NOZOMI_DEBUG + unsigned char stop_char = STOP_CHAR(tty); + unsigned char start_char = START_CHAR(tty); +#endif + /* if we are implementing INBOUND XON/XOFF */ + if (I_IXOFF(tty)) { + D1(" - INBOUND XON/XOFF is enabled, " + "XON = %2x, XOFF = %2x", start_char, stop_char); + } else { + D1(" - INBOUND XON/XOFF is disabled"); + } + + /* if we are implementing OUTBOUND XON/XOFF */ + if (I_IXON(tty)) { + D1(" - OUTBOUND XON/XOFF is enabled, " + "XON = %2x, XOFF = %2x", start_char, stop_char); + } else { + D1(" - OUTBOUND XON/XOFF is disabled"); + } + } + + exit_termios: + return; +} + +/* Gets io control parameters */ +static int ntty_tiocmget(struct tty_struct *tty, struct file *file) +{ + struct port *port = tty->driver_data; + ctrl_dl_t *ctrl_dl = &port->ctrl_dl; + ctrl_ul_t *ctrl_ul = &port->ctrl_ul; + + return 0 | (ctrl_ul->RTS ? TIOCM_RTS : 0) + | (ctrl_ul->DTR ? TIOCM_DTR : 0) + | (ctrl_dl->DCD ? TIOCM_CAR : 0) + | (ctrl_dl->RI ? TIOCM_RNG : 0) + | (ctrl_dl->DSR ? TIOCM_DSR : 0) + | (ctrl_dl->CTS ? TIOCM_CTS : 0); +} + +/* Sets io controls parameters */ +static int ntty_tiocmset(struct tty_struct *tty, struct file *file, u32 arg) +{ + struct port *port = (struct port *)tty->driver_data; + + set_rts(port->tty_index, (arg & TIOCM_RTS) ? 1 : 0); + set_dtr(port->tty_index, (arg & TIOCM_DTR) ? 1 : 0); + + return 0; +} + +static int ntty_ioctl_tiocmiwait(struct tty_struct *tty, struct file *file, + unsigned int cmd, unsigned long arg) +{ + struct port *port = (struct port *)tty->driver_data; + + if (cmd == TIOCMIWAIT) { + DECLARE_WAITQUEUE(wait, current); + struct async_icount cnow; + struct async_icount cprev; + + cprev = port->tty_icount; + while (1) { + add_wait_queue(&port->tty_wait, &wait); + set_current_state(TASK_INTERRUPTIBLE); + schedule(); + remove_wait_queue(&port->tty_wait, &wait); + + /* see if a signal woke us up */ + if (signal_pending(current)) + return -ERESTARTSYS; + + cnow = port->tty_icount; + if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr && + cnow.dcd == cprev.dcd && cnow.cts == cprev.cts) + return -EIO; /* no change => error */ + if (((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) || + ((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) || + ((arg & TIOCM_CD) && (cnow.dcd != cprev.dcd)) || + ((arg & TIOCM_CTS) && (cnow.cts != cprev.cts))) { + return 0; + } + cprev = cnow; + } + + } + return -ENOIOCTLCMD; +} + +static int ntty_ioctl_tiocgicount(struct tty_struct *tty, struct file *file, + unsigned int cmd, void __user * arg) +{ + struct port *port = (struct port *)tty->driver_data; + + if (cmd == TIOCGICOUNT) { + struct async_icount cnow = port->tty_icount; + struct serial_icounter_struct icount; + + icount.cts = cnow.cts; + icount.dsr = cnow.dsr; + icount.rng = cnow.rng; + icount.dcd = cnow.dcd; + icount.rx = cnow.rx; + icount.tx = cnow.tx; + icount.frame = cnow.frame; + icount.overrun = cnow.overrun; + icount.parity = cnow.parity; + icount.brk = cnow.brk; + icount.buf_overrun = cnow.buf_overrun; + + if (copy_to_user(arg, &icount, sizeof(icount))) + return -EFAULT; + return 0; + } + return -ENOIOCTLCMD; +} + +static int ntty_ioctl(struct tty_struct *tty, struct file *file, + unsigned int cmd, unsigned long arg) +{ + struct port *port = tty->driver_data; + dc_t *dc = get_dc_by_tty(tty); + unsigned long flags; + int mask; + int rval = -ENOIOCTLCMD; + + D1("******** IOCTL, cmd: %d", cmd); + + switch (cmd) { + case TCGETS: + D1("IOCTL TCGETS ..."); + rval = -ENOIOCTLCMD; + break; + case TCSETS: + D1("IOCTL TCSETS ..."); + rval = -ENOIOCTLCMD; + break; + case TIOCMIWAIT: + rval = ntty_ioctl_tiocmiwait(tty, file, cmd, arg); + break; + case TIOCGICOUNT: + rval = + ntty_ioctl_tiocgicount(tty, file, cmd, (void __user *)arg); + break; + case TIOCMGET: + spin_lock_irqsave(&dc->spin_mutex, flags); + rval = ntty_tiocmget(tty, file); + spin_unlock_irqrestore(&dc->spin_mutex, flags); + break; + case TIOCMSET: + rval = ntty_tiocmset(tty, file, arg); + break; + case TIOCMBIC: + if (get_user(mask, (unsigned long __user *)arg)) + return -EFAULT; + + spin_lock_irqsave(&dc->spin_mutex, flags); + if (mask & TIOCM_RTS) + set_rts(port->tty_index, 0); + if (mask & TIOCM_DTR) + set_dtr(port->tty_index, 0); + spin_unlock_irqrestore(&dc->spin_mutex, flags); + rval = 0; + break; + case TIOCMBIS: + if (get_user(mask, (unsigned long __user *)arg)) + return -EFAULT; + + spin_lock_irqsave(&dc->spin_mutex, flags); + if (mask & TIOCM_RTS) + set_rts(port->tty_index, 1); + if (mask & TIOCM_DTR) + set_dtr(port->tty_index, 1); + spin_unlock_irqrestore(&dc->spin_mutex, flags); + rval = 0; + break; + case TCFLSH: + D1("IOCTL TCFLSH ..."); + rval = -ENOIOCTLCMD; + break; + + default: + D1("ERR: 0x%08X, %d", cmd, cmd); + break; + }; + + return rval; +} + +/* Called by the upper tty layer when tty buffers are ready */ +/* to receive data again after a call to throttle. */ +static void ntty_unthrottle(struct tty_struct *tty) +{ + struct port *port = (struct port *)tty->driver_data; + dc_t *dc = get_dc_by_tty(tty); + unsigned long flags; + + D1("UNTHROTTLE"); + spin_lock_irqsave(&dc->spin_mutex, flags); + enable_transmit_dl(port->tty_index, dc); + set_rts(port->tty_index, 1); + + spin_unlock_irqrestore(&dc->spin_mutex, flags); +} + +/* Called by the upper tty layer when the tty buffers are almost full. */ +/* The driver should stop send more data. */ +static void ntty_throttle(struct tty_struct *tty) +{ + struct port *port = (struct port *)tty->driver_data; + dc_t *dc = get_dc_by_tty(tty); + unsigned long flags; + + D1("THROTTLE"); + spin_lock_irqsave(&dc->spin_mutex, flags); + set_rts(port->tty_index, 0); + spin_unlock_irqrestore(&dc->spin_mutex, flags); +} + +static void ntty_put_char(struct tty_struct *tty, unsigned char c) +{ + D2("PUT CHAR Function: %c", c); +} + +/* Returns number of chars in buffer, called by tty layer */ +static s32 ntty_chars_in_buffer(struct tty_struct *tty) +{ + struct port *port = (struct port *)tty->driver_data; + s32 rval; + + if (!port) { + rval = -ENODEV; + goto exit_in_buffer; + } + + if (!port->tty_open_count) { + ERR("No tty open?"); + rval = -ENODEV; + goto exit_in_buffer; + } + + rval = __kfifo_len(port->fifo_ul); + + exit_in_buffer: + return rval; +} + +static struct tty_operations tty_ops = { + .ioctl = ntty_ioctl, + .open = ntty_open, + .close = ntty_close, + .write = ntty_write, + .write_room = ntty_write_room, + .unthrottle = ntty_unthrottle, + .throttle = ntty_throttle, + .set_termios = ntty_set_termios, + .chars_in_buffer = ntty_chars_in_buffer, + .put_char = ntty_put_char, +}; + +/* Initializes the tty */ +static int ntty_tty_init(dc_t * dc) +{ + struct tty_driver *td; + int rval; + int i; + + dc->tty_driver = alloc_tty_driver(NTTY_TTY_MINORS); + if (!dc->tty_driver) + return -ENOMEM; + td = dc->tty_driver; + td->owner = THIS_MODULE; + td->driver_name = NOZOMI_NAME_TTY; + td->name = "noz"; + td->major = NTTY_TTY_MAJOR; + td->type = TTY_DRIVER_TYPE_SERIAL; + td->subtype = SERIAL_TYPE_NORMAL; +#ifdef KERNEL_2_6_18 + td->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV; +#else + td->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_NO_DEVFS; +#endif + td->init_termios = tty_std_termios; + td->init_termios.c_cflag = B115200 | CS8 | CREAD | HUPCL | CLOCAL; + +#ifdef KERNEL_2_4 + td->table = dc->tty_table; + td->refcount = &dc->tty_refcount; +#endif + + td->termios = dc->tty_termios; + td->termios_locked = dc->tty_termios_locked; + tty_set_operations(dc->tty_driver, &tty_ops); + + rval = tty_register_driver(td); + if (rval) { + dev_err(&dc->pdev->dev, "failed to register ntty tty driver\n"); + return rval; + } + + for (i = 0; i < NTTY_TTY_MINORS; i++) { + init_MUTEX(&dc->port[i].tty_sem); + dc->port[i].tty_open_count = 0; + dc->port[i].tty = NULL; +#ifdef KERNEL_2_6 + tty_register_device(td, i, &dc->pdev->dev); +#endif + } + + dev_info(&dc->pdev->dev, DRIVER_DESC " " NOZOMI_NAME_TTY "\n"); + return rval; +} + +/* Module initialization */ +static struct pci_driver nozomi_driver = { + .name = NOZOMI_NAME, + .id_table = nozomi_pci_tbl, + .probe = nozomi_card_init, + .remove = __devexit_p(nozomi_card_exit), +}; + +static __init int nozomi_init(void) +{ + int rval = 0; + + rval = pci_module_init(&nozomi_driver); + printk(KERN_INFO "Initializing %s\n", VERSION_STRING); + return rval; +} + +static __exit void nozomi_exit(void) +{ + printk(KERN_INFO "Unloading %s", DRIVER_DESC); + pci_unregister_driver(&nozomi_driver); +} + +module_init(nozomi_init); +module_exit(nozomi_exit); + +#ifdef NOZOMI_DEBUG +MODULE_PARM(nzdebug, "i"); +#endif + +MODULE_LICENSE("Dual BSD/GPL"); +MODULE_DESCRIPTION(DRIVER_DESC); diff --git a/readme b/readme new file mode 100755 index 0000000..10998c0 --- /dev/null +++ b/readme @@ -0,0 +1,26 @@ +To build this driver for your kernel, please check: + +For kernel 2.6 +--------------- +Check the Makefile and run 'make'. + +'make install' will copy the nozomi.ko module to the +/lib/modules/KERNEL_VERSION/kernel/drivers/pci/hotplug +directory and runs 'insmod' + +For kernel 2.4 +---------- +make HW=PC_24 + + + +Device Nodes +------------- +If this is the first time, you will need to run the following commands: +mknod /dev/noz0 c 241 0; mknod /dev/noz1 c 241 1; +mknod /dev/noz2 c 241 2; mknod /dev/noz3 c 241 3 + +If you have troubles: +--------------------- +1) Have proper kernel headers/source as your running kernel. +2) Make sure this variable in Makefile is correct KERNELDIR = -I/path/to/kernel diff --git a/todo b/todo new file mode 100755 index 0000000..2989752 --- /dev/null +++ b/todo @@ -0,0 +1,6 @@ +* When having a noz* open and rmmod module or removing card, + the driver core dumps. + +* Does not yet support multiple cards. + +* Add a helpful description. -- 2.43.0