2 * This program is free software; you can redistribute it and/or modify
3 * it under the terms of the GNU General Public License as published by
4 * the Free Software Foundation; either version 2 of the License, or
5 * (at your option) any later version.
7 * This program is distributed in the hope that it will be useful,
8 * but WITHOUT ANY WARRANTY; without even the implied warranty of
9 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
10 * GNU General Public License for more details.
12 * You should have received a copy of the GNU General Public License
13 * along with this program; if not, write to the Free Software
14 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA.
16 * Copyright (C) 2005 infineon
17 * Copyright (C) 2007 John Crispin <blogic@openwrt.org>
21 #include <linux/module.h>
22 #include <linux/types.h>
23 #include <linux/errno.h>
24 #include <linux/proc_fs.h>
25 #include <linux/init.h>
26 #include <linux/ioctl.h>
27 #include <asm/semaphore.h>
28 #include <asm/uaccess.h>
29 #include <asm/danube/danube.h>
30 #include <asm/danube/danube_ioctl.h>
33 #define DANUBE_PORT_OUT_REG 0x00000010
34 #define DANUBE_PORT_IN_REG 0x00000014
35 #define DANUBE_PORT_DIR_REG 0x00000018
36 #define DANUBE_PORT_ALTSEL0_REG 0x0000001C
37 #define DANUBE_PORT_ALTSEL1_REG 0x00000020
38 #define DANUBE_PORT_OD_REG 0x00000024
39 #define DANUBE_PORT_STOFF_REG 0x00000028
40 #define DANUBE_PORT_PUDSEL_REG 0x0000002C
41 #define DANUBE_PORT_PUDEN_REG 0x00000030
43 #define PORT_MODULE_ID 0xff
45 #define PORT_WRITE_REG(reg, value) \
46 *((volatile u32*)(reg)) = (u32)value;
48 #define PORT_READ_REG(reg, value) \
49 value = (u32)*((volatile u32*)(reg));
51 #define PORT_IOC_CALL(ret,port,pin,func) \
52 ret=danube_port_reserve_pin(port,pin,PORT_MODULE_ID); \
53 if (ret == 0) ret=func(port,pin,PORT_MODULE_ID); \
54 if (ret == 0) ret=danube_port_free_pin(port,pin,PORT_MODULE_ID);
57 #define MAX_PORTS 2 // Number of ports in system
58 #define PINS_PER_PORT 16 // Number of available pins per port
60 static int port_major = 0;
61 static int danube_port_pin_usage[MAX_PORTS][PINS_PER_PORT]; // Map for pin usage
62 static u32 danube_port_bases[MAX_PORTS]
63 = { DANUBE_GPIO_BASE_ADDR, DANUBE_GPIO_P0_PUDEN };
65 static struct semaphore port_sem;
68 danube_port_reserve_pin (int port, int pin, int module_id)
70 if (port < 0 || pin < 0)
72 if (port > MAX_PORTS || pin > PINS_PER_PORT)
75 if (danube_port_pin_usage[port][pin] == 0) {
76 danube_port_pin_usage[port][pin] = module_id;
86 danube_port_free_pin (int port, int pin, int module_id)
89 if (port < 0 || pin < 0)
91 if (port > MAX_PORTS || pin > PINS_PER_PORT)
94 if (danube_port_pin_usage[port][pin] != module_id)
96 danube_port_pin_usage[port][pin] = 0;
102 danube_port_set_open_drain (int port, int pin, int module_id)
106 if (port < 0 || pin < 0)
108 if (port > MAX_PORTS || pin > PINS_PER_PORT)
111 if (danube_port_pin_usage[port][pin] != module_id)
114 PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_OD_REG, reg);
116 PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_OD_REG, reg);
122 danube_port_clear_open_drain (int port, int pin, int module_id)
126 if (port < 0 || pin < 0)
128 if (port > MAX_PORTS || pin > PINS_PER_PORT)
131 if (danube_port_pin_usage[port][pin] != module_id)
134 PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_OD_REG, reg);
136 PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_OD_REG, reg);
142 danube_port_set_pudsel (int port, int pin, int module_id)
146 if (port < 0 || pin < 0)
148 if (port > MAX_PORTS || pin > PINS_PER_PORT)
151 if (danube_port_pin_usage[port][pin] != module_id)
154 PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_PUDSEL_REG, reg);
156 PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_PUDSEL_REG,
163 danube_port_clear_pudsel (int port, int pin, int module_id)
167 if (port < 0 || pin < 0)
169 if (port > MAX_PORTS || pin > PINS_PER_PORT)
172 if (danube_port_pin_usage[port][pin] != module_id)
175 PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_PUDSEL_REG, reg);
177 PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_PUDSEL_REG,
184 danube_port_set_puden (int port, int pin, int module_id)
188 if (port < 0 || pin < 0)
190 if (port > MAX_PORTS || pin > PINS_PER_PORT)
193 if (danube_port_pin_usage[port][pin] != module_id)
196 PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_PUDEN_REG, reg);
198 PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_PUDEN_REG, reg);
204 danube_port_clear_puden (int port, int pin, int module_id)
208 if (port < 0 || pin < 0)
210 if (port > MAX_PORTS || pin > PINS_PER_PORT)
213 if (danube_port_pin_usage[port][pin] != module_id)
216 PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_PUDEN_REG, reg);
218 PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_PUDEN_REG, reg);
224 danube_port_set_stoff (int port, int pin, int module_id)
228 if (port < 0 || pin < 0)
230 if (port > MAX_PORTS || pin > PINS_PER_PORT)
233 if (danube_port_pin_usage[port][pin] != module_id)
236 PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_STOFF_REG, reg);
238 PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_STOFF_REG, reg);
244 danube_port_clear_stoff (int port, int pin, int module_id)
248 if (port < 0 || pin < 0)
250 if (port > MAX_PORTS || pin > PINS_PER_PORT)
253 if (danube_port_pin_usage[port][pin] != module_id)
256 PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_STOFF_REG, reg);
258 PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_STOFF_REG, reg);
264 danube_port_set_dir_out (int port, int pin, int module_id)
268 if (port < 0 || pin < 0)
270 if (port > MAX_PORTS || pin > PINS_PER_PORT)
273 if (danube_port_pin_usage[port][pin] != module_id)
276 PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_DIR_REG, reg);
278 PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_DIR_REG, reg);
284 danube_port_set_dir_in (int port, int pin, int module_id)
288 if (port < 0 || pin < 0)
290 if (port > MAX_PORTS || pin > PINS_PER_PORT)
293 if (danube_port_pin_usage[port][pin] != module_id)
296 PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_DIR_REG, reg);
298 PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_DIR_REG, reg);
304 danube_port_set_output (int port, int pin, int module_id)
308 if (port < 0 || pin < 0)
310 if (port > MAX_PORTS || pin > PINS_PER_PORT)
313 if (danube_port_pin_usage[port][pin] != module_id)
316 PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_OUT_REG, reg);
318 PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_OUT_REG, reg);
324 danube_port_clear_output (int port, int pin, int module_id)
328 if (port < 0 || pin < 0)
330 if (port > MAX_PORTS || pin > PINS_PER_PORT)
333 if (danube_port_pin_usage[port][pin] != module_id)
336 PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_OUT_REG, reg);
338 PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_OUT_REG, reg);
344 danube_port_get_input (int port, int pin, int module_id)
348 if (port < 0 || pin < 0)
350 if (port > MAX_PORTS || pin > PINS_PER_PORT)
353 if (danube_port_pin_usage[port][pin] != module_id)
356 PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_IN_REG, reg);
365 danube_port_set_altsel0 (int port, int pin, int module_id)
369 if (port < 0 || pin < 0)
371 if (port > MAX_PORTS || pin > PINS_PER_PORT)
374 if (danube_port_pin_usage[port][pin] != module_id)
377 PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL0_REG,
380 PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL0_REG,
387 danube_port_clear_altsel0 (int port, int pin, int module_id)
391 if (port < 0 || pin < 0)
393 if (port > MAX_PORTS || pin > PINS_PER_PORT)
396 if (danube_port_pin_usage[port][pin] != module_id)
399 PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL0_REG,
402 PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL0_REG,
409 danube_port_set_altsel1 (int port, int pin, int module_id)
413 if (port < 0 || pin < 0)
415 if (port > MAX_PORTS || pin > PINS_PER_PORT)
418 if (danube_port_pin_usage[port][pin] != module_id)
421 PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL1_REG,
424 PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL1_REG,
431 danube_port_clear_altsel1 (int port, int pin, int module_id)
435 if (port < 0 || pin < 0)
437 if (port > MAX_PORTS || pin > PINS_PER_PORT)
440 if (danube_port_pin_usage[port][pin] != module_id)
443 PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL1_REG,
446 PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL1_REG,
453 danube_port_read_procmem (char *buf, char **start, off_t offset, int count,
454 int *eof, void *data)
461 len = sprintf (buf, "\nDanube Port Settings\n");
463 len = len + sprintf (buf + len,
465 len = len + sprintf (buf + len,
466 " 10987654321098765432109876543210\n");
467 len = len + sprintf (buf + len,
468 "----------------------------------------\n");
470 len = len + sprintf (buf + len, "\nP0-OUT: ");
471 PORT_READ_REG (DANUBE_GPIO_P0_OUT, reg);
473 for (t = 0; t < 32; t++) {
475 len = len + sprintf (buf + len, "X");
477 len = len + sprintf (buf + len, " ");
481 len = len + sprintf (buf + len, "\nP1-OUT: ");
482 PORT_READ_REG (DANUBE_GPIO_P1_OUT, reg);
484 for (t = 0; t < 32; t++) {
486 len = len + sprintf (buf + len, "X");
488 len = len + sprintf (buf + len, " ");
492 len = len + sprintf (buf + len, "\nP0-IN: ");
493 PORT_READ_REG (DANUBE_GPIO_P0_IN, reg);
495 for (t = 0; t < 32; t++) {
497 len = len + sprintf (buf + len, "X");
499 len = len + sprintf (buf + len, " ");
503 len = len + sprintf (buf + len, "\nP1-IN: ");
504 PORT_READ_REG (DANUBE_GPIO_P1_IN, reg);
506 for (t = 0; t < 32; t++) {
508 len = len + sprintf (buf + len, "X");
510 len = len + sprintf (buf + len, " ");
514 len = len + sprintf (buf + len, "\nP0-DIR: ");
515 PORT_READ_REG (DANUBE_GPIO_P0_DIR, reg);
517 for (t = 0; t < 32; t++) {
519 len = len + sprintf (buf + len, "X");
521 len = len + sprintf (buf + len, " ");
525 len = len + sprintf (buf + len, "\nP1-DIR: ");
526 PORT_READ_REG (DANUBE_GPIO_P1_DIR, reg);
528 for (t = 0; t < 32; t++) {
530 len = len + sprintf (buf + len, "X");
532 len = len + sprintf (buf + len, " ");
536 len = len + sprintf (buf + len, "\nP0-STO: ");
537 PORT_READ_REG (DANUBE_GPIO_P0_STOFF, reg);
539 for (t = 0; t < 32; t++) {
541 len = len + sprintf (buf + len, "X");
543 len = len + sprintf (buf + len, " ");
547 len = len + sprintf (buf + len, "\nP1-STO: ");
548 PORT_READ_REG (DANUBE_GPIO_P1_STOFF, reg);
550 for (t = 0; t < 32; t++) {
552 len = len + sprintf (buf + len, "X");
554 len = len + sprintf (buf + len, " ");
558 len = len + sprintf (buf + len, "\nP0-PUDE:");
559 PORT_READ_REG (DANUBE_GPIO_P0_PUDEN, reg);
561 for (t = 0; t < 32; t++) {
563 len = len + sprintf (buf + len, "X");
565 len = len + sprintf (buf + len, " ");
569 len = len + sprintf (buf + len, "\nP1-PUDE:");
570 PORT_READ_REG (DANUBE_GPIO_P1_PUDEN, reg);
572 for (t = 0; t < 32; t++) {
574 len = len + sprintf (buf + len, "X");
576 len = len + sprintf (buf + len, " ");
580 len = len + sprintf (buf + len, "\nP0-OD: ");
581 PORT_READ_REG (DANUBE_GPIO_P0_OD, reg);
583 for (t = 0; t < 32; t++) {
585 len = len + sprintf (buf + len, "X");
587 len = len + sprintf (buf + len, " ");
591 len = len + sprintf (buf + len, "\nP1-OD: ");
592 PORT_READ_REG (DANUBE_GPIO_P1_OD, reg);
594 for (t = 0; t < 32; t++) {
596 len = len + sprintf (buf + len, "X");
598 len = len + sprintf (buf + len, " ");
602 len = len + sprintf (buf + len, "\nP0-PUDS:");
603 PORT_READ_REG (DANUBE_GPIO_P0_PUDSEL, reg);
605 for (t = 0; t < 32; t++) {
607 len = len + sprintf (buf + len, "X");
609 len = len + sprintf (buf + len, " ");
613 len = len + sprintf (buf + len, "\nP1-PUDS:");
614 PORT_READ_REG (DANUBE_GPIO_P1_PUDSEL, reg);
616 for (t = 0; t < 32; t++) {
618 len = len + sprintf (buf + len, "X");
620 len = len + sprintf (buf + len, " ");
624 len = len + sprintf (buf + len, "\nP0_ALT0:");
625 PORT_READ_REG (DANUBE_GPIO_P0_ALTSEL0, reg);
627 for (t = 0; t < 32; t++) {
629 len = len + sprintf (buf + len, "X");
631 len = len + sprintf (buf + len, " ");
635 len = len + sprintf (buf + len, "\nP0_ALT1:");
636 PORT_READ_REG (DANUBE_GPIO_P0_ALTSEL1, reg);
638 for (t = 0; t < 32; t++) {
640 len = len + sprintf (buf + len, "X");
642 len = len + sprintf (buf + len, " ");
646 len = len + sprintf (buf + len, "\nP1_ALT0:");
647 PORT_READ_REG (DANUBE_GPIO_P1_ALTSEL0, reg);
649 for (t = 0; t < 32; t++) {
651 len = len + sprintf (buf + len, "X");
653 len = len + sprintf (buf + len, " ");
657 len = len + sprintf (buf + len, "\nP1_ALT1:");
658 PORT_READ_REG (DANUBE_GPIO_P1_ALTSEL1, reg);
660 for (t = 0; t < 32; t++) {
662 len = len + sprintf (buf + len, "X");
664 len = len + sprintf (buf + len, " ");
668 len = len + sprintf (buf + len, "\n\n");
670 *eof = 1; // No more data available
675 danube_port_open (struct inode *inode, struct file *filep)
681 danube_port_release (struct inode *inode, struct file *filelp)
687 danube_port_ioctl (struct inode *inode, struct file *filp,
688 unsigned int cmd, unsigned long arg)
691 volatile struct danube_port_ioctl_parm parm;
693 if (_IOC_TYPE (cmd) != DANUBE_PORT_IOC_MAGIC)
696 if (_IOC_DIR (cmd) & _IOC_WRITE) {
699 sizeof (struct danube_port_ioctl_parm)))
701 ret = copy_from_user ((void *) &parm, (void *) arg,
702 sizeof (struct danube_port_ioctl_parm));
704 if (_IOC_DIR (cmd) & _IOC_READ) {
707 sizeof (struct danube_port_ioctl_parm)))
711 if (down_trylock (&port_sem) != 0)
715 case DANUBE_PORT_IOCOD:
716 if (parm.value == 0x00) {
717 PORT_IOC_CALL (ret, parm.port, parm.pin,
718 danube_port_clear_open_drain);
721 PORT_IOC_CALL (ret, parm.port, parm.pin,
722 danube_port_set_open_drain);
725 case DANUBE_PORT_IOCPUDSEL:
726 if (parm.value == 0x00) {
727 PORT_IOC_CALL (ret, parm.port, parm.pin,
728 danube_port_clear_pudsel);
731 PORT_IOC_CALL (ret, parm.port, parm.pin,
732 danube_port_set_pudsel);
735 case DANUBE_PORT_IOCPUDEN:
736 if (parm.value == 0x00) {
737 PORT_IOC_CALL (ret, parm.port, parm.pin,
738 danube_port_clear_puden);
741 PORT_IOC_CALL (ret, parm.port, parm.pin,
742 danube_port_set_puden);
745 case DANUBE_PORT_IOCSTOFF:
746 if (parm.value == 0x00) {
747 PORT_IOC_CALL (ret, parm.port, parm.pin,
748 danube_port_clear_stoff);
751 PORT_IOC_CALL (ret, parm.port, parm.pin,
752 danube_port_set_stoff);
755 case DANUBE_PORT_IOCDIR:
756 if (parm.value == 0x00) {
757 PORT_IOC_CALL (ret, parm.port, parm.pin,
758 danube_port_set_dir_in);
761 PORT_IOC_CALL (ret, parm.port, parm.pin,
762 danube_port_set_dir_out);
765 case DANUBE_PORT_IOCOUTPUT:
766 if (parm.value == 0x00) {
767 PORT_IOC_CALL (ret, parm.port, parm.pin,
768 danube_port_clear_output);
771 PORT_IOC_CALL (ret, parm.port, parm.pin,
772 danube_port_set_output);
775 case DANUBE_PORT_IOCALTSEL0:
776 if (parm.value == 0x00) {
777 PORT_IOC_CALL (ret, parm.port, parm.pin,
778 danube_port_clear_altsel0);
781 PORT_IOC_CALL (ret, parm.port, parm.pin,
782 danube_port_set_altsel0);
785 case DANUBE_PORT_IOCALTSEL1:
786 if (parm.value == 0x00) {
787 PORT_IOC_CALL (ret, parm.port, parm.pin,
788 danube_port_clear_altsel1);
791 PORT_IOC_CALL (ret, parm.port, parm.pin,
792 danube_port_set_altsel1);
795 case DANUBE_PORT_IOCINPUT:
796 ret = danube_port_reserve_pin (parm.port, parm.pin,
800 danube_port_get_input (parm.port, parm.pin,
802 ret = danube_port_free_pin (parm.port, parm.pin,
804 copy_to_user ((void *) arg, (void *) &parm,
805 sizeof (struct danube_port_ioctl_parm));
816 static struct file_operations port_fops = {
817 open:danube_port_open,
818 release:danube_port_release,
819 ioctl:danube_port_ioctl
823 danube_port_init (void)
828 printk ("Danube Port Initialization\n");
830 sema_init (&port_sem, 1);
832 /* Check ports for available pins */
833 for (t = 0; t < MAX_PORTS; t++) {
834 for (i = 0; i < PINS_PER_PORT; i++)
835 danube_port_pin_usage[t][i] = 0;
838 /* register port device */
839 err = register_chrdev (0, "danube-port", &port_fops);
843 printk ("danube-port: Error! Could not register port device. #%d\n", err);
847 /* Create proc file */
848 create_proc_read_entry ("driver/danube_port", 0, NULL,
849 danube_port_read_procmem, NULL);
854 module_init (danube_port_init);
856 EXPORT_SYMBOL (danube_port_reserve_pin);
857 EXPORT_SYMBOL (danube_port_free_pin);
858 EXPORT_SYMBOL (danube_port_set_open_drain);
859 EXPORT_SYMBOL (danube_port_clear_open_drain);
860 EXPORT_SYMBOL (danube_port_set_pudsel);
861 EXPORT_SYMBOL (danube_port_clear_pudsel);
862 EXPORT_SYMBOL (danube_port_set_puden);
863 EXPORT_SYMBOL (danube_port_clear_puden);
864 EXPORT_SYMBOL (danube_port_set_stoff);
865 EXPORT_SYMBOL (danube_port_clear_stoff);
866 EXPORT_SYMBOL (danube_port_set_dir_out);
867 EXPORT_SYMBOL (danube_port_set_dir_in);
868 EXPORT_SYMBOL (danube_port_set_output);
869 EXPORT_SYMBOL (danube_port_clear_output);
870 EXPORT_SYMBOL (danube_port_get_input);
872 EXPORT_SYMBOL (danube_port_set_altsel0);
873 EXPORT_SYMBOL (danube_port_clear_altsel0);
874 EXPORT_SYMBOL (danube_port_set_altsel1);
875 EXPORT_SYMBOL (danube_port_clear_altsel1);