*** linux-vr-2001-05-17/drivers/char/console.c.old	Fri May 25 02:43:13 2001
--- linux-vr-2001-05-17/drivers/char/console.c	Fri May 25 02:53:17 2001
***************
*** 107,113 ****
  
  #include "console_macros.h"
  
! 
  struct consw *conswitchp = NULL;
  
  /* A bitmap for codes <32. A bit of 1 indicates that the code
--- 107,118 ----
  
  #include "console_macros.h"
  
! #if defined(CONFIG_AGENDA_VR3)
!  /* led support */
! #include <linux/delay.h>
! #include <asm/vr4181.h>
! #endif
!  
  struct consw *conswitchp = NULL;
  
  /* A bitmap for codes <32. A bit of 1 indicates that the code
***************
*** 1234,1239 ****
--- 1239,1245 ----
  
  static void setterm_command(int currcons)
  {
+ 	unsigned long flags;
  	switch(par[0]) {
  		case 1:	/* set color for underline mode */
  			if (can_do_color && par[1] < 16) {
***************
*** 1283,1288 ****
--- 1289,1330 ----
  		case 14: /* set vesa powerdown interval */
  			vesa_off_interval = ((par[1] < 60) ? par[1] : 60) * 60 * HZ;
  			break;
+ #if defined(CONFIG_AGENDA_VR3)
+ 			 /* led support */
+ 		case 15:
+ 			save_and_cli(flags);
+ 			if (par[1]) /* green on */
+ 				*VR41XX_GPDATHREG &= ~(VR41XX_GPDATHREG_GPIO16);
+ 			else /* green off */
+ 				*VR41XX_GPDATHREG |= VR41XX_GPDATHREG_GPIO16;
+ 			restore_flags(flags);
+ 			break;
+ 		case 16:
+ 			save_and_cli(flags);
+ 			*VR41XX_LEDHTSREG=par[1];
+ 			restore_flags(flags);
+ 			break;
+ 		case 17:
+ 			save_and_cli(flags);
+ 			*VR41XX_LEDLTSREG=par[1];
+ 			restore_flags(flags);
+ 			break;
+ 		case 18:
+ 			save_and_cli(flags);
+ 			*VR41XX_LEDCNTREG=par[1];
+ 			restore_flags(flags);
+ 			break;
+ 		case 19:
+ 			save_and_cli(flags);
+ 			*VR41XX_LEDASTCREG=par[1];
+ 			restore_flags(flags);
+ 			break;
+ 		case 20:
+ 			save_and_cli(flags);
+ 			*VR41XX_LEDINTREG=par[1];
+ 			restore_flags(flags);
+ 			break;
+ #endif
  	}
  }