Initial commit of OpenSPARC T2 architecture model.

[OpenSPARC-T2-SAM] / sam-t2 / sam / devices / common / console.cc

// ========== Copyright Header Begin ==========================================
// 
// OpenSPARC T2 Processor File: console.cc
// Copyright (c) 2006 Sun Microsystems, Inc.  All Rights Reserved.
// DO NOT ALTER OR REMOVE COPYRIGHT NOTICES.
// 
// The above named program is free software; you can redistribute it and/or
// modify it under the terms of the GNU General Public
// License version 2 as published by the Free Software Foundation.
// 
// The above named 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 work; if not, write to the Free Software
// Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301, USA.
// 
// ========== Copyright Header End ============================================
#include <fcntl.h>
#include <termio.h>
#include "console.h"


bool console::get_pty(char **name, int *sfd, int *mfd){
       if ((*mfd = open("/dev/ptmx", O_RDWR|O_NDELAY)) == -1) {
           fprintf(stderr,"get_pty: Cannot find a pseudo tty.\n");
           return false;
       }

       if (grantpt(*mfd) < 0) {
           fprintf(stderr,"get_pty: Could not grant access to slave pseudo tty\n");
           perror("grantpt");
           close(*mfd);
           return false;
       }

       if (unlockpt(*mfd) < 0) {
           fprintf(stderr,"get_pty: Unable to unlock pseudo tty.\n");
           perror("unlockpt");
           close(*mfd);
           return false;
       }
   
       *name = strdup(ptsname(*mfd));
       *sfd = open(*name, O_RDWR | O_NOCTTY);
   
       if (*sfd < 0) {
           fprintf(stderr,"get_pty: Unable to open slave side for %d\n", *mfd);
           close(*mfd);
           return false;
       }

       if (ioctl(*sfd, I_PUSH, "ptem") < 0) {
           fprintf(stderr,"get_pty: Ioctl I_PUSH ptem failed\n");
           perror("ioctl i_push ptem");
           close(*mfd);
           return false;
       }

       if (ioctl(*sfd, I_PUSH, "ldterm") < 0) {
           fprintf(stderr,"serial: Ioctl I_PUSH ldterm failed\n");
           perror("ioctl i_push ldterm");
           close(*mfd);
           return false;
       }

       chmod(*name,S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP | S_IROTH | S_IWOTH);

       struct termio tty;

       ioctl(*sfd, TCGETA, &tty);
       tty.c_lflag    &= ~(ICANON|ECHO|ECHOE|ECHOK|ECHONL);
       tty.c_cc[VMIN]  = 1;
       tty.c_cc[VTIME] = 0;
       ioctl(*sfd, TCSETA, &tty);

       return true;
}

void console::term_read_ports(fd_set readfds){
       unsigned char buf[256];

       for(termMapIter = termMap.begin(); termMapIter!= termMap.end(); termMapIter++){
           if (FD_ISSET(termMapIter->second->mport_fd, &readfds)) {
               int nbytes;
               unsigned char ch;
               int index = 0;
               
               while ((nbytes = read(termMapIter->second->mport_fd, &ch, 1)) == 1){
                   buf[index++] = ch;
                   buf[index] = 0;
                   termMapIter->second->cbFun(termMapIter->second->cbData, buf, termMapIter->first);
                   index = 0;
               }
           }
       }
}
//return a unique port identifier and the tty name for tip connection in tty_name
int console::getTerminal(char * title, int numScrolLines, inputCallbk cbFun, void * cbData, char ** tty_name, bool pop_win){

       console::title = strdup(title);
       term_lines = numScrolLines;

       term * t = new term();
       int retVal;
       if(!get_pty(&t->tty_name, &t->port_fd, &t->mport_fd)){
           delete t;
           return -1;
       }
       t->cbFun = cbFun;
       t->cbData = cbData;

       pthread_mutex_lock(&termMutex);
       termMap[currentPortNum++] = t;
       retVal = currentPortNum - 1;
       pthread_mutex_unlock(&termMutex);

       if(pop_win)
           t->pop_term(display, fn, bg, fg, title, numScrolLines, exec);

       *tty_name = strdup(t->tty_name);
       return retVal;
}

void console::term_select(){

       fd_set readFd;
       int n;        
       struct timeval tval;
       //time out every 1 second, to check if additional consoles have been added.
       tval.tv_sec = 1;
       tval.tv_usec = 0;

       for(;;){
           FD_ZERO(&readFd);

           for(termMapIter = termMap.begin(); termMapIter!= termMap.end(); termMapIter++)
               FD_SET(termMapIter->second->mport_fd, &readFd);

           n = select(FD_SETSIZE, &readFd, (fd_set *)0,(fd_set *)0, &tval);    
       
           switch (n) {
               case -1:         /* error */
                   break;
               case 0:             /* timeout */
                   break;
               default:         /* input available */
                   term_read_ports(readFd);
               break;
           }
       }

}



void * callTermThread(void * arg){
   console * t = (console*)arg;
   t->term_select();    
   return (void*)0;
}