2005-04-17 00:20:36 +02:00
/*
* * - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - -
* *
* * Perle Specialix driver for Linux
* * Ported from existing RIO Driver for SCO sources .
*
* ( C ) 1990 - 2000 Specialix International Ltd . , Byfleet , Surrey , UK .
*
* 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 0213 9 , USA .
* *
* * Module : riotable . c
* * SID : 1.2
* * Last Modified : 11 / 6 / 98 10 : 33 : 47
* * Retrieved : 11 / 6 / 98 10 : 33 : 50
* *
* * ident @ ( # ) riotable . c 1.2
* *
* * - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - - -
*/
# ifdef SCCS_LABELS
static char * _riotable_c_sccs_ = " @(#)riotable.c 1.2 " ;
# endif
# include <linux/module.h>
# include <linux/slab.h>
# include <linux/errno.h>
# include <linux/interrupt.h>
# include <linux/string.h>
# include <asm/io.h>
# include <asm/system.h>
# include <asm/string.h>
# include <asm/semaphore.h>
# include <asm/uaccess.h>
# include <linux/termios.h>
# include <linux/serial.h>
# include <linux/generic_serial.h>
# include "linux_compat.h"
# include "rio_linux.h"
# include "pkt.h"
# include "daemon.h"
# include "rio.h"
# include "riospace.h"
# include "cmdpkt.h"
# include "map.h"
# include "rup.h"
# include "port.h"
# include "riodrvr.h"
# include "rioinfo.h"
# include "func.h"
# include "errors.h"
# include "pci.h"
# include "parmmap.h"
# include "unixrup.h"
# include "board.h"
# include "host.h"
# include "phb.h"
# include "link.h"
# include "cmdblk.h"
# include "route.h"
# include "cirrus.h"
# include "rioioctl.h"
# include "param.h"
# include "protsts.h"
/*
* * A configuration table has been loaded . It is now up to us
* * to sort it out and use the information contained therein .
*/
2006-03-24 12:18:27 +01:00
int RIONewTable ( struct rio_info * p )
2005-04-17 00:20:36 +02:00
{
int Host , Host1 , Host2 , NameIsUnique , Entry , SubEnt ;
struct Map * MapP ;
struct Map * HostMapP ;
struct Host * HostP ;
char * cptr ;
/*
2006-01-11 21:17:49 +01:00
* * We have been sent a new table to install . We need to break
* * it down into little bits and spread it around a bit to see
* * what we have got .
*/
2005-04-17 00:20:36 +02:00
/*
2006-01-11 21:17:49 +01:00
* * Things to check :
* * ( things marked ' xx ' aren ' t checked any more ! )
* * ( 1 ) That there are no booted Hosts / RTAs out there .
* * ( 2 ) That the names are properly formed
* * ( 3 ) That blank entries really are .
* * xx ( 4 ) That hosts mentioned in the table actually exist . xx
* * ( 5 ) That the IDs are unique ( per host ) .
* * ( 6 ) That host IDs are zero
* * ( 7 ) That port numbers are valid
* * ( 8 ) That port numbers aren ' t duplicated
* * ( 9 ) That names aren ' t duplicated
* * xx ( 10 ) That hosts that actually exist are mentioned in the table . xx
*/
rio_dprintk ( RIO_DEBUG_TABLE , " RIONewTable: entering(1) \n " ) ;
if ( p - > RIOSystemUp ) { /* (1) */
2005-04-17 00:20:36 +02:00
p - > RIOError . Error = HOST_HAS_ALREADY_BEEN_BOOTED ;
return - EBUSY ;
}
p - > RIOError . Error = NOTHING_WRONG_AT_ALL ;
p - > RIOError . Entry = - 1 ;
p - > RIOError . Other = - 1 ;
2006-01-11 21:17:49 +01:00
for ( Entry = 0 ; Entry < TOTAL_MAP_ENTRIES ; Entry + + ) {
2005-04-17 00:20:36 +02:00
MapP = & p - > RIOConnectTable [ Entry ] ;
if ( ( MapP - > Flags & RTA16_SECOND_SLOT ) = = 0 ) {
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " RIONewTable: entering(2) \n " ) ;
cptr = MapP - > Name ; /* (2) */
cptr [ MAX_NAME_LEN - 1 ] = ' \0 ' ;
if ( cptr [ 0 ] = = ' \0 ' ) {
2006-03-24 12:18:32 +01:00
memcpy ( MapP - > Name , MapP - > RtaUniqueNum ? " RTA NN " : " HOST NN " , 8 ) ;
2006-01-11 21:17:49 +01:00
MapP - > Name [ 5 ] = ' 0 ' + Entry / 10 ;
MapP - > Name [ 6 ] = ' 0 ' + Entry % 10 ;
2005-04-17 00:20:36 +02:00
}
2006-01-11 21:17:49 +01:00
while ( * cptr ) {
if ( * cptr < ' ' | | * cptr > ' ~ ' ) {
2005-04-17 00:20:36 +02:00
p - > RIOError . Error = BAD_CHARACTER_IN_NAME ;
p - > RIOError . Entry = Entry ;
return - ENXIO ;
}
cptr + + ;
}
}
/*
2006-01-11 21:17:49 +01:00
* * If the entry saved was a tentative entry then just forget
* * about it .
*/
if ( MapP - > Flags & SLOT_TENTATIVE ) {
2005-04-17 00:20:36 +02:00
MapP - > HostUniqueNum = 0 ;
MapP - > RtaUniqueNum = 0 ;
continue ;
}
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " RIONewTable: entering(3) \n " ) ;
if ( ! MapP - > RtaUniqueNum & & ! MapP - > HostUniqueNum ) { /* (3) */
if ( MapP - > ID | | MapP - > SysPort | | MapP - > Flags ) {
rio_dprintk ( RIO_DEBUG_TABLE , " %s pretending to be empty but isn't \n " , MapP - > Name ) ;
2005-04-17 00:20:36 +02:00
p - > RIOError . Error = TABLE_ENTRY_ISNT_PROPERLY_NULL ;
p - > RIOError . Entry = Entry ;
return - ENXIO ;
}
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " !RIO: Daemon: test (3) passes \n " ) ;
2005-04-17 00:20:36 +02:00
continue ;
}
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " RIONewTable: entering(4) \n " ) ;
for ( Host = 0 ; Host < p - > RIONumHosts ; Host + + ) { /* (4) */
if ( p - > RIOHosts [ Host ] . UniqueNum = = MapP - > HostUniqueNum ) {
2005-04-17 00:20:36 +02:00
HostP = & p - > RIOHosts [ Host ] ;
/*
2006-01-11 21:17:49 +01:00
* * having done the lookup , we don ' t really want to do
* * it again , so hang the host number in a safe place
*/
2005-04-17 00:20:36 +02:00
MapP - > Topology [ 0 ] . Unit = Host ;
break ;
}
}
2006-01-11 21:17:49 +01:00
if ( Host > = p - > RIONumHosts ) {
rio_dprintk ( RIO_DEBUG_TABLE , " RTA %s has unknown host unique number 0x%x \n " , MapP - > Name , MapP - > HostUniqueNum ) ;
2005-04-17 00:20:36 +02:00
MapP - > HostUniqueNum = 0 ;
2006-01-11 21:17:49 +01:00
/* MapP->RtaUniqueNum = 0; */
/* MapP->ID = 0; */
/* MapP->Flags = 0; */
/* MapP->SysPort = 0; */
/* MapP->Name[0] = 0; */
2005-04-17 00:20:36 +02:00
continue ;
}
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " RIONewTable: entering(5) \n " ) ;
if ( MapP - > RtaUniqueNum ) { /* (5) */
if ( ! MapP - > ID ) {
rio_dprintk ( RIO_DEBUG_TABLE , " RIO: RTA %s has been allocated an ID of zero! \n " , MapP - > Name ) ;
p - > RIOError . Error = ZERO_RTA_ID ;
2005-04-17 00:20:36 +02:00
p - > RIOError . Entry = Entry ;
return - ENXIO ;
}
2006-01-11 21:17:49 +01:00
if ( MapP - > ID > MAX_RUP ) {
rio_dprintk ( RIO_DEBUG_TABLE , " RIO: RTA %s has been allocated an invalid ID %d \n " , MapP - > Name , MapP - > ID ) ;
2005-04-17 00:20:36 +02:00
p - > RIOError . Error = ID_NUMBER_OUT_OF_RANGE ;
p - > RIOError . Entry = Entry ;
return - ENXIO ;
}
2006-01-11 21:17:49 +01:00
for ( SubEnt = 0 ; SubEnt < Entry ; SubEnt + + ) {
if ( MapP - > HostUniqueNum = = p - > RIOConnectTable [ SubEnt ] . HostUniqueNum & & MapP - > ID = = p - > RIOConnectTable [ SubEnt ] . ID ) {
rio_dprintk ( RIO_DEBUG_TABLE , " Dupl. ID number allocated to RTA %s and RTA %s \n " , MapP - > Name , p - > RIOConnectTable [ SubEnt ] . Name ) ;
2005-04-17 00:20:36 +02:00
p - > RIOError . Error = DUPLICATED_RTA_ID ;
p - > RIOError . Entry = Entry ;
p - > RIOError . Other = SubEnt ;
return - ENXIO ;
}
/*
2006-01-11 21:17:49 +01:00
* * If the RtaUniqueNum is the same , it may be looking at both
* * entries for a 16 port RTA , so check the ids
*/
if ( ( MapP - > RtaUniqueNum = = p - > RIOConnectTable [ SubEnt ] . RtaUniqueNum )
& & ( MapP - > ID2 ! = p - > RIOConnectTable [ SubEnt ] . ID ) ) {
rio_dprintk ( RIO_DEBUG_TABLE , " RTA %s has duplicate unique number \n " , MapP - > Name ) ;
rio_dprintk ( RIO_DEBUG_TABLE , " RTA %s has duplicate unique number \n " , p - > RIOConnectTable [ SubEnt ] . Name ) ;
2005-04-17 00:20:36 +02:00
p - > RIOError . Error = DUPLICATE_UNIQUE_NUMBER ;
p - > RIOError . Entry = Entry ;
p - > RIOError . Other = SubEnt ;
return - ENXIO ;
}
}
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " RIONewTable: entering(7a) \n " ) ;
2005-04-17 00:20:36 +02:00
/* (7a) */
2006-01-11 21:17:49 +01:00
if ( ( MapP - > SysPort ! = NO_PORT ) & & ( MapP - > SysPort % PORTS_PER_RTA ) ) {
rio_dprintk ( RIO_DEBUG_TABLE , " TTY Port number %d-RTA %s is not a multiple of %d! \n " , ( int ) MapP - > SysPort , MapP - > Name , PORTS_PER_RTA ) ;
2005-04-17 00:20:36 +02:00
p - > RIOError . Error = TTY_NUMBER_OUT_OF_RANGE ;
p - > RIOError . Entry = Entry ;
return - ENXIO ;
}
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " RIONewTable: entering(7b) \n " ) ;
2005-04-17 00:20:36 +02:00
/* (7b) */
2006-01-11 21:17:49 +01:00
if ( ( MapP - > SysPort ! = NO_PORT ) & & ( MapP - > SysPort > = RIO_PORTS ) ) {
rio_dprintk ( RIO_DEBUG_TABLE , " TTY Port number %d for RTA %s is too big \n " , ( int ) MapP - > SysPort , MapP - > Name ) ;
2005-04-17 00:20:36 +02:00
p - > RIOError . Error = TTY_NUMBER_OUT_OF_RANGE ;
p - > RIOError . Entry = Entry ;
return - ENXIO ;
}
2006-01-11 21:17:49 +01:00
for ( SubEnt = 0 ; SubEnt < Entry ; SubEnt + + ) {
if ( p - > RIOConnectTable [ SubEnt ] . Flags & RTA16_SECOND_SLOT )
continue ;
if ( p - > RIOConnectTable [ SubEnt ] . RtaUniqueNum ) {
rio_dprintk ( RIO_DEBUG_TABLE , " RIONewTable: entering(8) \n " ) ;
2005-04-17 00:20:36 +02:00
/* (8) */
2006-01-11 21:17:49 +01:00
if ( ( MapP - > SysPort ! = NO_PORT ) & & ( MapP - > SysPort = = p - > RIOConnectTable [ SubEnt ] . SysPort ) ) {
rio_dprintk ( RIO_DEBUG_TABLE , " RTA %s:same TTY port # as RTA %s (%d) \n " , MapP - > Name , p - > RIOConnectTable [ SubEnt ] . Name , ( int ) MapP - > SysPort ) ;
2005-04-17 00:20:36 +02:00
p - > RIOError . Error = TTY_NUMBER_IN_USE ;
p - > RIOError . Entry = Entry ;
p - > RIOError . Other = SubEnt ;
return - ENXIO ;
}
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " RIONewTable: entering(9) \n " ) ;
if ( strcmp ( MapP - > Name , p - > RIOConnectTable [ SubEnt ] . Name ) = = 0 & & ! ( MapP - > Flags & RTA16_SECOND_SLOT ) ) { /* (9) */
rio_dprintk ( RIO_DEBUG_TABLE , " RTA name %s used twice \n " , MapP - > Name ) ;
2005-04-17 00:20:36 +02:00
p - > RIOError . Error = NAME_USED_TWICE ;
p - > RIOError . Entry = Entry ;
p - > RIOError . Other = SubEnt ;
return - ENXIO ;
}
}
}
2006-01-11 21:17:49 +01:00
} else { /* (6) */
rio_dprintk ( RIO_DEBUG_TABLE , " RIONewTable: entering(6) \n " ) ;
if ( MapP - > ID ) {
rio_dprintk ( RIO_DEBUG_TABLE , " RIO:HOST %s has been allocated ID that isn't zero! \n " , MapP - > Name ) ;
2005-04-17 00:20:36 +02:00
p - > RIOError . Error = HOST_ID_NOT_ZERO ;
p - > RIOError . Entry = Entry ;
return - ENXIO ;
}
2006-01-11 21:17:49 +01:00
if ( MapP - > SysPort ! = NO_PORT ) {
rio_dprintk ( RIO_DEBUG_TABLE , " RIO: HOST %s has been allocated port numbers! \n " , MapP - > Name ) ;
2005-04-17 00:20:36 +02:00
p - > RIOError . Error = HOST_SYSPORT_BAD ;
p - > RIOError . Entry = Entry ;
return - ENXIO ;
}
}
}
/*
2006-01-11 21:17:49 +01:00
* * wow ! if we get here then it ' s a goody !
*/
2005-04-17 00:20:36 +02:00
/*
2006-01-11 21:17:49 +01:00
* * Zero the ( old ) entries for each host . . .
*/
for ( Host = 0 ; Host < RIO_HOSTS ; Host + + ) {
for ( Entry = 0 ; Entry < MAX_RUP ; Entry + + ) {
2006-03-24 12:18:27 +01:00
memset ( & p - > RIOHosts [ Host ] . Mapping [ Entry ] , 0 , sizeof ( struct Map ) ) ;
2005-04-17 00:20:36 +02:00
}
2006-03-24 12:18:27 +01:00
memset ( & p - > RIOHosts [ Host ] . Name [ 0 ] , 0 , sizeof ( p - > RIOHosts [ Host ] . Name ) ) ;
2005-04-17 00:20:36 +02:00
}
/*
2006-01-11 21:17:49 +01:00
* * Copy in the new table entries
*/
for ( Entry = 0 ; Entry < TOTAL_MAP_ENTRIES ; Entry + + ) {
rio_dprintk ( RIO_DEBUG_TABLE , " RIONewTable: Copy table for Host entry %d \n " , Entry ) ;
2005-04-17 00:20:36 +02:00
MapP = & p - > RIOConnectTable [ Entry ] ;
/*
2006-01-11 21:17:49 +01:00
* * Now , if it is an empty slot ignore it !
*/
if ( MapP - > HostUniqueNum = = 0 )
2005-04-17 00:20:36 +02:00
continue ;
/*
2006-01-11 21:17:49 +01:00
* * we saved the host number earlier , so grab it back
*/
2005-04-17 00:20:36 +02:00
HostP = & p - > RIOHosts [ MapP - > Topology [ 0 ] . Unit ] ;
/*
2006-01-11 21:17:49 +01:00
* * If it is a host , then we only need to fill in the name field .
*/
if ( MapP - > ID = = 0 ) {
rio_dprintk ( RIO_DEBUG_TABLE , " Host entry found. Name %s \n " , MapP - > Name ) ;
2006-03-24 12:18:32 +01:00
memcpy ( HostP - > Name , MapP - > Name , MAX_NAME_LEN ) ;
2005-04-17 00:20:36 +02:00
continue ;
}
/*
2006-01-11 21:17:49 +01:00
* * Its an RTA entry , so fill in the host mapping entries for it
* * and the port mapping entries . Notice that entry zero is for
* * ID one .
*/
HostMapP = & HostP - > Mapping [ MapP - > ID - 1 ] ;
2005-04-17 00:20:36 +02:00
if ( MapP - > Flags & SLOT_IN_USE ) {
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " Rta entry found. Name %s \n " , MapP - > Name ) ;
2005-04-17 00:20:36 +02:00
/*
2006-01-11 21:17:49 +01:00
* * structure assign , then sort out the bits we shouldn ' t have done
*/
2005-04-17 00:20:36 +02:00
* HostMapP = * MapP ;
HostMapP - > Flags = SLOT_IN_USE ;
if ( MapP - > Flags & RTA16_SECOND_SLOT )
HostMapP - > Flags | = RTA16_SECOND_SLOT ;
2006-01-11 21:17:49 +01:00
RIOReMapPorts ( p , HostP , HostMapP ) ;
} else {
rio_dprintk ( RIO_DEBUG_TABLE , " TENTATIVE Rta entry found. Name %s \n " , MapP - > Name ) ;
2005-04-17 00:20:36 +02:00
}
}
2006-01-11 21:17:49 +01:00
for ( Entry = 0 ; Entry < TOTAL_MAP_ENTRIES ; Entry + + ) {
2005-04-17 00:20:36 +02:00
p - > RIOSavedTable [ Entry ] = p - > RIOConnectTable [ Entry ] ;
}
2006-01-11 21:17:49 +01:00
for ( Host = 0 ; Host < p - > RIONumHosts ; Host + + ) {
for ( SubEnt = 0 ; SubEnt < LINKS_PER_UNIT ; SubEnt + + ) {
2005-04-17 00:20:36 +02:00
p - > RIOHosts [ Host ] . Topology [ SubEnt ] . Unit = ROUTE_DISCONNECT ;
p - > RIOHosts [ Host ] . Topology [ SubEnt ] . Link = NO_LINK ;
}
2006-01-11 21:17:49 +01:00
for ( Entry = 0 ; Entry < MAX_RUP ; Entry + + ) {
for ( SubEnt = 0 ; SubEnt < LINKS_PER_UNIT ; SubEnt + + ) {
p - > RIOHosts [ Host ] . Mapping [ Entry ] . Topology [ SubEnt ] . Unit = ROUTE_DISCONNECT ;
p - > RIOHosts [ Host ] . Mapping [ Entry ] . Topology [ SubEnt ] . Link = NO_LINK ;
2005-04-17 00:20:36 +02:00
}
}
2006-01-11 21:17:49 +01:00
if ( ! p - > RIOHosts [ Host ] . Name [ 0 ] ) {
2006-03-24 12:18:32 +01:00
memcpy ( p - > RIOHosts [ Host ] . Name , " HOST 1 " , 7 ) ;
2005-04-17 00:20:36 +02:00
p - > RIOHosts [ Host ] . Name [ 5 ] + = Host ;
}
/*
2006-01-11 21:17:49 +01:00
* * Check that default name assigned is unique .
*/
2005-04-17 00:20:36 +02:00
Host1 = Host ;
NameIsUnique = 0 ;
while ( ! NameIsUnique ) {
NameIsUnique = 1 ;
2006-01-11 21:17:49 +01:00
for ( Host2 = 0 ; Host2 < p - > RIONumHosts ; Host2 + + ) {
2005-04-17 00:20:36 +02:00
if ( Host2 = = Host )
continue ;
if ( strcmp ( p - > RIOHosts [ Host ] . Name , p - > RIOHosts [ Host2 ] . Name )
2006-01-11 21:17:49 +01:00
= = 0 ) {
2005-04-17 00:20:36 +02:00
NameIsUnique = 0 ;
Host1 + + ;
if ( Host1 > = p - > RIONumHosts )
Host1 = 0 ;
p - > RIOHosts [ Host ] . Name [ 5 ] = ' 1 ' + Host1 ;
}
}
}
/*
2006-01-11 21:17:49 +01:00
* * Rename host if name already used .
*/
if ( Host1 ! = Host ) {
rio_dprintk ( RIO_DEBUG_TABLE , " Default name %s already used \n " , p - > RIOHosts [ Host ] . Name ) ;
2006-03-24 12:18:32 +01:00
memcpy ( p - > RIOHosts [ Host ] . Name , " HOST 1 " , 7 ) ;
2005-04-17 00:20:36 +02:00
p - > RIOHosts [ Host ] . Name [ 5 ] + = Host1 ;
}
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " Assigning default name %s \n " , p - > RIOHosts [ Host ] . Name ) ;
2005-04-17 00:20:36 +02:00
}
return 0 ;
}
/*
* * User process needs the config table - build it from first
* * principles .
2006-03-24 12:18:27 +01:00
* *
* FIXME : SMP locking
2005-04-17 00:20:36 +02:00
*/
2006-03-24 12:18:27 +01:00
int RIOApel ( struct rio_info * p )
2005-04-17 00:20:36 +02:00
{
int Host ;
int link ;
int Rup ;
int Next = 0 ;
struct Map * MapP ;
struct Host * HostP ;
2006-03-24 12:18:27 +01:00
unsigned long flags ;
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " Generating a table to return to config.rio \n " ) ;
2005-04-17 00:20:36 +02:00
2006-03-24 12:18:27 +01:00
memset ( & p - > RIOConnectTable [ 0 ] , 0 , sizeof ( struct Map ) * TOTAL_MAP_ENTRIES ) ;
2005-04-17 00:20:36 +02:00
2006-01-11 21:17:49 +01:00
for ( Host = 0 ; Host < RIO_HOSTS ; Host + + ) {
rio_dprintk ( RIO_DEBUG_TABLE , " Processing host %d \n " , Host ) ;
2005-04-17 00:20:36 +02:00
HostP = & p - > RIOHosts [ Host ] ;
2006-03-24 12:18:27 +01:00
rio_spin_lock_irqsave ( & HostP - > HostLock , flags ) ;
2005-04-17 00:20:36 +02:00
MapP = & p - > RIOConnectTable [ Next + + ] ;
MapP - > HostUniqueNum = HostP - > UniqueNum ;
2006-01-11 21:17:49 +01:00
if ( ( HostP - > Flags & RUN_STATE ) ! = RC_RUNNING )
2005-04-17 00:20:36 +02:00
continue ;
MapP - > RtaUniqueNum = 0 ;
MapP - > ID = 0 ;
MapP - > Flags = SLOT_IN_USE ;
MapP - > SysPort = NO_PORT ;
2006-01-11 21:17:49 +01:00
for ( link = 0 ; link < LINKS_PER_UNIT ; link + + )
2005-04-17 00:20:36 +02:00
MapP - > Topology [ link ] = HostP - > Topology [ link ] ;
2006-03-24 12:18:32 +01:00
memcpy ( MapP - > Name , HostP - > Name , MAX_NAME_LEN ) ;
2006-01-11 21:17:49 +01:00
for ( Rup = 0 ; Rup < MAX_RUP ; Rup + + ) {
if ( HostP - > Mapping [ Rup ] . Flags & ( SLOT_IN_USE | SLOT_TENTATIVE ) ) {
2005-04-17 00:20:36 +02:00
p - > RIOConnectTable [ Next ] = HostP - > Mapping [ Rup ] ;
2006-01-11 21:17:49 +01:00
if ( HostP - > Mapping [ Rup ] . Flags & SLOT_IN_USE )
2005-04-17 00:20:36 +02:00
p - > RIOConnectTable [ Next ] . Flags | = SLOT_IN_USE ;
2006-01-11 21:17:49 +01:00
if ( HostP - > Mapping [ Rup ] . Flags & SLOT_TENTATIVE )
2005-04-17 00:20:36 +02:00
p - > RIOConnectTable [ Next ] . Flags | = SLOT_TENTATIVE ;
2006-01-11 21:17:49 +01:00
if ( HostP - > Mapping [ Rup ] . Flags & RTA16_SECOND_SLOT )
2005-04-17 00:20:36 +02:00
p - > RIOConnectTable [ Next ] . Flags | = RTA16_SECOND_SLOT ;
Next + + ;
}
}
2006-03-24 12:18:27 +01:00
rio_spin_unlock_irqrestore ( & HostP - > HostLock , flags ) ;
2005-04-17 00:20:36 +02:00
}
return 0 ;
}
/*
* * config . rio has taken a dislike to one of the gross maps entries .
* * if the entry is suitably inactive , then we can gob on it and remove
* * it from the table .
*/
2006-03-24 12:18:27 +01:00
int RIODeleteRta ( struct rio_info * p , struct Map * MapP )
2005-04-17 00:20:36 +02:00
{
int host , entry , port , link ;
int SysPort ;
struct Host * HostP ;
struct Map * HostMapP ;
struct Port * PortP ;
int work_done = 0 ;
unsigned long lock_flags , sem_flags ;
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " Delete entry on host %x, rta %x \n " , MapP - > HostUniqueNum , MapP - > RtaUniqueNum ) ;
2005-04-17 00:20:36 +02:00
2006-01-11 21:17:49 +01:00
for ( host = 0 ; host < p - > RIONumHosts ; host + + ) {
2005-04-17 00:20:36 +02:00
HostP = & p - > RIOHosts [ host ] ;
2006-01-11 21:17:49 +01:00
rio_spin_lock_irqsave ( & HostP - > HostLock , lock_flags ) ;
2005-04-17 00:20:36 +02:00
2006-01-11 21:17:49 +01:00
if ( ( HostP - > Flags & RUN_STATE ) ! = RC_RUNNING ) {
2005-04-17 00:20:36 +02:00
rio_spin_unlock_irqrestore ( & HostP - > HostLock , lock_flags ) ;
continue ;
}
2006-01-11 21:17:49 +01:00
for ( entry = 0 ; entry < MAX_RUP ; entry + + ) {
if ( MapP - > RtaUniqueNum = = HostP - > Mapping [ entry ] . RtaUniqueNum ) {
2005-04-17 00:20:36 +02:00
HostMapP = & HostP - > Mapping [ entry ] ;
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " Found entry offset %d on host %s \n " , entry , HostP - > Name ) ;
2005-04-17 00:20:36 +02:00
/*
2006-01-11 21:17:49 +01:00
* * Check all four links of the unit are disconnected
*/
for ( link = 0 ; link < LINKS_PER_UNIT ; link + + ) {
if ( HostMapP - > Topology [ link ] . Unit ! = ROUTE_DISCONNECT ) {
rio_dprintk ( RIO_DEBUG_TABLE , " Entry is in use and cannot be deleted! \n " ) ;
2005-04-17 00:20:36 +02:00
p - > RIOError . Error = UNIT_IS_IN_USE ;
2006-01-11 21:17:49 +01:00
rio_spin_unlock_irqrestore ( & HostP - > HostLock , lock_flags ) ;
2005-04-17 00:20:36 +02:00
return - EBUSY ;
}
}
/*
2006-01-11 21:17:49 +01:00
* * Slot has been allocated , BUT not booted / routed /
* * connected / selected or anything else - ed
*/
2005-04-17 00:20:36 +02:00
SysPort = HostMapP - > SysPort ;
2006-01-11 21:17:49 +01:00
if ( SysPort ! = NO_PORT ) {
for ( port = SysPort ; port < SysPort + PORTS_PER_RTA ; port + + ) {
2005-04-17 00:20:36 +02:00
PortP = p - > RIOPortp [ port ] ;
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " Unmap port \n " ) ;
2005-04-17 00:20:36 +02:00
2006-01-11 21:17:49 +01:00
rio_spin_lock_irqsave ( & PortP - > portSem , sem_flags ) ;
2005-04-17 00:20:36 +02:00
PortP - > Mapped = 0 ;
2006-01-11 21:17:49 +01:00
if ( PortP - > State & ( RIO_MOPEN | RIO_LOPEN ) ) {
2005-04-17 00:20:36 +02:00
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " Gob on port \n " ) ;
2005-04-17 00:20:36 +02:00
PortP - > TxBufferIn = PortP - > TxBufferOut = 0 ;
/* What should I do
2006-01-11 21:17:49 +01:00
wakeup ( & PortP - > TxBufferIn ) ;
wakeup ( & PortP - > TxBufferOut ) ;
*/
2005-04-17 00:20:36 +02:00
PortP - > InUse = NOT_INUSE ;
/* What should I do
2006-01-11 21:17:49 +01:00
wakeup ( & PortP - > InUse ) ;
signal ( PortP - > TtyP - > t_pgrp , SIGKILL ) ;
ttyflush ( PortP - > TtyP , ( FREAD | FWRITE ) ) ;
*/
2005-04-17 00:20:36 +02:00
PortP - > State | = RIO_CLOSING | RIO_DELETED ;
}
/*
2006-01-11 21:17:49 +01:00
* * For the second slot of a 16 port RTA , the
* * driver needs to reset the changes made to
* * the phb to port mappings in RIORouteRup .
*/
2005-04-17 00:20:36 +02:00
if ( PortP - > SecondBlock ) {
2006-03-24 12:18:32 +01:00
u16 dest_unit = HostMapP - > ID ;
u16 dest_port = port - SysPort ;
2006-03-24 12:18:27 +01:00
u16 * TxPktP ;
2006-03-24 12:18:32 +01:00
struct PKT * Pkt ;
2005-04-17 00:20:36 +02:00
2006-01-11 21:17:49 +01:00
for ( TxPktP = PortP - > TxStart ; TxPktP < = PortP - > TxEnd ; TxPktP + + ) {
2005-04-17 00:20:36 +02:00
/*
2006-01-11 21:17:49 +01:00
* * * TxPktP is the pointer to the
* * transmit packet on the host card .
* * This needs to be translated into
* * a 32 bit pointer so it can be
* * accessed from the driver .
*/
2006-03-24 12:18:32 +01:00
Pkt = ( struct PKT * ) RIO_PTR ( HostP - > Caddr , readw ( & * TxPktP ) ) ;
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " Tx packet (%x) destination: Old %x:%x New %x:%x \n " , * TxPktP , Pkt - > dest_unit , Pkt - > dest_port , dest_unit , dest_port ) ;
2006-03-24 12:18:27 +01:00
writew ( dest_unit , & Pkt - > dest_unit ) ;
writew ( dest_port , & Pkt - > dest_port ) ;
2005-04-17 00:20:36 +02:00
}
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " Port %d phb destination: Old %x:%x New %x:%x \n " , port , PortP - > PhbP - > destination & 0xff , ( PortP - > PhbP - > destination > > 8 ) & 0xff , dest_unit , dest_port ) ;
2006-03-24 12:18:27 +01:00
writew ( dest_unit + ( dest_port < < 8 ) , & PortP - > PhbP - > destination ) ;
2005-04-17 00:20:36 +02:00
}
rio_spin_unlock_irqrestore ( & PortP - > portSem , sem_flags ) ;
}
}
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " Entry nulled. \n " ) ;
2006-03-24 12:18:27 +01:00
memset ( HostMapP , 0 , sizeof ( struct Map ) ) ;
2005-04-17 00:20:36 +02:00
work_done + + ;
}
}
rio_spin_unlock_irqrestore ( & HostP - > HostLock , lock_flags ) ;
}
/* XXXXX lock me up */
2006-01-11 21:17:49 +01:00
for ( entry = 0 ; entry < TOTAL_MAP_ENTRIES ; entry + + ) {
if ( p - > RIOSavedTable [ entry ] . RtaUniqueNum = = MapP - > RtaUniqueNum ) {
2006-03-24 12:18:27 +01:00
memset ( & p - > RIOSavedTable [ entry ] , 0 , sizeof ( struct Map ) ) ;
2005-04-17 00:20:36 +02:00
work_done + + ;
}
2006-01-11 21:17:49 +01:00
if ( p - > RIOConnectTable [ entry ] . RtaUniqueNum = = MapP - > RtaUniqueNum ) {
2006-03-24 12:18:27 +01:00
memset ( & p - > RIOConnectTable [ entry ] , 0 , sizeof ( struct Map ) ) ;
2005-04-17 00:20:36 +02:00
work_done + + ;
}
}
2006-01-11 21:17:49 +01:00
if ( work_done )
2005-04-17 00:20:36 +02:00
return 0 ;
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " Couldn't find entry to be deleted \n " ) ;
2005-04-17 00:20:36 +02:00
p - > RIOError . Error = COULDNT_FIND_ENTRY ;
return - ENXIO ;
}
2006-01-11 21:17:49 +01:00
int RIOAssignRta ( struct rio_info * p , struct Map * MapP )
2005-04-17 00:20:36 +02:00
{
2006-01-11 21:17:49 +01:00
int host ;
struct Map * HostMapP ;
char * sptr ;
int link ;
rio_dprintk ( RIO_DEBUG_TABLE , " Assign entry on host %x, rta %x, ID %d, Sysport %d \n " , MapP - > HostUniqueNum , MapP - > RtaUniqueNum , MapP - > ID , ( int ) MapP - > SysPort ) ;
2006-03-24 12:18:32 +01:00
if ( ( MapP - > ID ! = ( u16 ) - 1 ) & & ( ( int ) MapP - > ID < ( int ) 1 | | ( int ) MapP - > ID > MAX_RUP ) ) {
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " Bad ID in map entry! \n " ) ;
p - > RIOError . Error = ID_NUMBER_OUT_OF_RANGE ;
return - EINVAL ;
}
if ( MapP - > RtaUniqueNum = = 0 ) {
rio_dprintk ( RIO_DEBUG_TABLE , " Rta Unique number zero! \n " ) ;
p - > RIOError . Error = RTA_UNIQUE_NUMBER_ZERO ;
return - EINVAL ;
}
if ( ( MapP - > SysPort ! = NO_PORT ) & & ( MapP - > SysPort % PORTS_PER_RTA ) ) {
rio_dprintk ( RIO_DEBUG_TABLE , " Port %d not multiple of %d! \n " , ( int ) MapP - > SysPort , PORTS_PER_RTA ) ;
p - > RIOError . Error = TTY_NUMBER_OUT_OF_RANGE ;
return - EINVAL ;
}
if ( ( MapP - > SysPort ! = NO_PORT ) & & ( MapP - > SysPort > = RIO_PORTS ) ) {
rio_dprintk ( RIO_DEBUG_TABLE , " Port %d not valid! \n " , ( int ) MapP - > SysPort ) ;
p - > RIOError . Error = TTY_NUMBER_OUT_OF_RANGE ;
return - EINVAL ;
}
/*
* * Copy the name across to the map entry .
*/
MapP - > Name [ MAX_NAME_LEN - 1 ] = ' \0 ' ;
sptr = MapP - > Name ;
while ( * sptr ) {
if ( * sptr < ' ' | | * sptr > ' ~ ' ) {
rio_dprintk ( RIO_DEBUG_TABLE , " Name entry contains non-printing characters! \n " ) ;
p - > RIOError . Error = BAD_CHARACTER_IN_NAME ;
return - EINVAL ;
2005-04-17 00:20:36 +02:00
}
2006-01-11 21:17:49 +01:00
sptr + + ;
}
for ( host = 0 ; host < p - > RIONumHosts ; host + + ) {
if ( MapP - > HostUniqueNum = = p - > RIOHosts [ host ] . UniqueNum ) {
if ( ( p - > RIOHosts [ host ] . Flags & RUN_STATE ) ! = RC_RUNNING ) {
p - > RIOError . Error = HOST_NOT_RUNNING ;
return - ENXIO ;
}
2005-04-17 00:20:36 +02:00
2006-01-11 21:17:49 +01:00
/*
* * Now we have a host we need to allocate an ID
* * if the entry does not already have one .
*/
2006-03-24 12:18:32 +01:00
if ( MapP - > ID = = ( u16 ) - 1 ) {
2006-01-11 21:17:49 +01:00
int nNewID ;
2005-04-17 00:20:36 +02:00
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " Attempting to get a new ID for rta \" %s \" \n " , MapP - > Name ) ;
/*
* * The idea here is to allow RTA ' s to be assigned
* * before they actually appear on the network .
* * This allows the addition of RTA ' s without having
* * to plug them in .
* * What we do is :
* * - Find a free ID and allocate it to the RTA .
* * - If this map entry is the second half of a
* * 16 port entry then find the other half and
* * make sure the 2 cross reference each other .
*/
if ( RIOFindFreeID ( p , & p - > RIOHosts [ host ] , & nNewID , NULL ) ! = 0 ) {
p - > RIOError . Error = COULDNT_FIND_ENTRY ;
return - EBUSY ;
}
2006-03-24 12:18:32 +01:00
MapP - > ID = ( u16 ) nNewID + 1 ;
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " Allocated ID %d for this new RTA. \n " , MapP - > ID ) ;
HostMapP = & p - > RIOHosts [ host ] . Mapping [ nNewID ] ;
HostMapP - > RtaUniqueNum = MapP - > RtaUniqueNum ;
HostMapP - > HostUniqueNum = MapP - > HostUniqueNum ;
HostMapP - > ID = MapP - > ID ;
for ( link = 0 ; link < LINKS_PER_UNIT ; link + + ) {
HostMapP - > Topology [ link ] . Unit = ROUTE_DISCONNECT ;
HostMapP - > Topology [ link ] . Link = NO_LINK ;
}
if ( MapP - > Flags & RTA16_SECOND_SLOT ) {
int unit ;
for ( unit = 0 ; unit < MAX_RUP ; unit + + )
if ( p - > RIOHosts [ host ] . Mapping [ unit ] . RtaUniqueNum = = MapP - > RtaUniqueNum )
break ;
if ( unit = = MAX_RUP ) {
p - > RIOError . Error = COULDNT_FIND_ENTRY ;
return - EBUSY ;
}
HostMapP - > Flags | = RTA16_SECOND_SLOT ;
HostMapP - > ID2 = MapP - > ID2 = p - > RIOHosts [ host ] . Mapping [ unit ] . ID ;
p - > RIOHosts [ host ] . Mapping [ unit ] . ID2 = MapP - > ID ;
rio_dprintk ( RIO_DEBUG_TABLE , " Cross referenced id %d to ID %d. \n " , MapP - > ID , p - > RIOHosts [ host ] . Mapping [ unit ] . ID ) ;
}
}
HostMapP = & p - > RIOHosts [ host ] . Mapping [ MapP - > ID - 1 ] ;
if ( HostMapP - > Flags & SLOT_IN_USE ) {
rio_dprintk ( RIO_DEBUG_TABLE , " Map table slot for ID %d is already in use. \n " , MapP - > ID ) ;
p - > RIOError . Error = ID_ALREADY_IN_USE ;
return - EBUSY ;
}
/*
* * Assign the sys ports and the name , and mark the slot as
* * being in use .
*/
HostMapP - > SysPort = MapP - > SysPort ;
if ( ( MapP - > Flags & RTA16_SECOND_SLOT ) = = 0 )
2006-03-24 12:18:32 +01:00
memcpy ( HostMapP - > Name , MapP - > Name , MAX_NAME_LEN ) ;
2006-01-11 21:17:49 +01:00
HostMapP - > Flags = SLOT_IN_USE | RTA_BOOTED ;
2005-07-27 20:45:17 +02:00
# ifdef NEED_TO_FIX
2006-01-11 21:17:49 +01:00
RIO_SV_BROADCAST ( p - > RIOHosts [ host ] . svFlags [ MapP - > ID - 1 ] ) ;
2005-04-17 00:20:36 +02:00
# endif
2006-01-11 21:17:49 +01:00
if ( MapP - > Flags & RTA16_SECOND_SLOT )
HostMapP - > Flags | = RTA16_SECOND_SLOT ;
RIOReMapPorts ( p , & p - > RIOHosts [ host ] , HostMapP ) ;
/*
* * Adjust 2 nd block of 8 phbs
*/
if ( MapP - > Flags & RTA16_SECOND_SLOT )
RIOFixPhbs ( p , & p - > RIOHosts [ host ] , HostMapP - > ID - 1 ) ;
if ( HostMapP - > SysPort ! = NO_PORT ) {
if ( HostMapP - > SysPort < p - > RIOFirstPortsBooted )
p - > RIOFirstPortsBooted = HostMapP - > SysPort ;
if ( HostMapP - > SysPort > p - > RIOLastPortsBooted )
p - > RIOLastPortsBooted = HostMapP - > SysPort ;
}
if ( MapP - > Flags & RTA16_SECOND_SLOT )
rio_dprintk ( RIO_DEBUG_TABLE , " Second map of RTA %s added to configuration \n " , p - > RIOHosts [ host ] . Mapping [ MapP - > ID2 - 1 ] . Name ) ;
else
rio_dprintk ( RIO_DEBUG_TABLE , " RTA %s added to configuration \n " , MapP - > Name ) ;
return 0 ;
}
2005-04-17 00:20:36 +02:00
}
2006-01-11 21:17:49 +01:00
p - > RIOError . Error = UNKNOWN_HOST_NUMBER ;
rio_dprintk ( RIO_DEBUG_TABLE , " Unknown host %x \n " , MapP - > HostUniqueNum ) ;
return - ENXIO ;
2005-04-17 00:20:36 +02:00
}
2006-03-24 12:18:27 +01:00
int RIOReMapPorts ( struct rio_info * p , struct Host * HostP , struct Map * HostMapP )
2005-04-17 00:20:36 +02:00
{
2006-03-24 12:18:27 +01:00
struct Port * PortP ;
2006-03-24 12:18:32 +01:00
unsigned int SubEnt ;
unsigned int HostPort ;
unsigned int SysPort ;
u16 RtaType ;
2005-04-17 00:20:36 +02:00
unsigned long flags ;
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " Mapping sysport %d to id %d \n " , ( int ) HostMapP - > SysPort , HostMapP - > ID ) ;
2005-04-17 00:20:36 +02:00
/*
2006-01-11 21:17:49 +01:00
* * We need to tell the UnixRups which sysport the rup corresponds to
*/
HostP - > UnixRups [ HostMapP - > ID - 1 ] . BaseSysPort = HostMapP - > SysPort ;
2005-04-17 00:20:36 +02:00
2006-01-11 21:17:49 +01:00
if ( HostMapP - > SysPort = = NO_PORT )
return ( 0 ) ;
2005-04-17 00:20:36 +02:00
RtaType = GetUnitType ( HostMapP - > RtaUniqueNum ) ;
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " Mapping sysport %d-%d \n " , ( int ) HostMapP - > SysPort , ( int ) HostMapP - > SysPort + PORTS_PER_RTA - 1 ) ;
2005-04-17 00:20:36 +02:00
/*
2006-01-11 21:17:49 +01:00
* * now map each of its eight ports
*/
for ( SubEnt = 0 ; SubEnt < PORTS_PER_RTA ; SubEnt + + ) {
rio_dprintk ( RIO_DEBUG_TABLE , " subent = %d, HostMapP->SysPort = %d \n " , SubEnt , ( int ) HostMapP - > SysPort ) ;
SysPort = HostMapP - > SysPort + SubEnt ; /* portnumber within system */
/* portnumber on host */
HostPort = ( HostMapP - > ID - 1 ) * PORTS_PER_RTA + SubEnt ;
rio_dprintk ( RIO_DEBUG_TABLE , " c1 p = %p, p->rioPortp = %p \n " , p , p - > RIOPortp ) ;
2005-04-17 00:20:36 +02:00
PortP = p - > RIOPortp [ SysPort ] ;
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " Map port \n " ) ;
2005-04-17 00:20:36 +02:00
/*
2006-01-11 21:17:49 +01:00
* * Point at all the real neat data structures
*/
2005-04-17 00:20:36 +02:00
rio_spin_lock_irqsave ( & PortP - > portSem , flags ) ;
PortP - > HostP = HostP ;
PortP - > Caddr = HostP - > Caddr ;
/*
2006-01-11 21:17:49 +01:00
* * The PhbP cannot be filled in yet
* * unless the host has been booted
*/
2005-04-17 00:20:36 +02:00
if ( ( HostP - > Flags & RUN_STATE ) = = RC_RUNNING ) {
struct PHB * PhbP = PortP - > PhbP = & HostP - > PhbP [ HostPort ] ;
2006-03-24 12:18:27 +01:00
PortP - > TxAdd = ( u16 * ) RIO_PTR ( HostP - > Caddr , readw ( & PhbP - > tx_add ) ) ;
PortP - > TxStart = ( u16 * ) RIO_PTR ( HostP - > Caddr , readw ( & PhbP - > tx_start ) ) ;
PortP - > TxEnd = ( u16 * ) RIO_PTR ( HostP - > Caddr , readw ( & PhbP - > tx_end ) ) ;
PortP - > RxRemove = ( u16 * ) RIO_PTR ( HostP - > Caddr , readw ( & PhbP - > rx_remove ) ) ;
PortP - > RxStart = ( u16 * ) RIO_PTR ( HostP - > Caddr , readw ( & PhbP - > rx_start ) ) ;
PortP - > RxEnd = ( u16 * ) RIO_PTR ( HostP - > Caddr , readw ( & PhbP - > rx_end ) ) ;
2006-01-11 21:17:49 +01:00
} else
2005-04-17 00:20:36 +02:00
PortP - > PhbP = NULL ;
/*
2006-01-11 21:17:49 +01:00
* * port related flags
*/
PortP - > HostPort = HostPort ;
2005-04-17 00:20:36 +02:00
/*
2006-01-11 21:17:49 +01:00
* * For each part of a 16 port RTA , RupNum is ID - 1.
*/
2005-04-17 00:20:36 +02:00
PortP - > RupNum = HostMapP - > ID - 1 ;
if ( HostMapP - > Flags & RTA16_SECOND_SLOT ) {
2006-01-11 21:17:49 +01:00
PortP - > ID2 = HostMapP - > ID2 - 1 ;
2006-03-24 12:18:32 +01:00
PortP - > SecondBlock = 1 ;
2006-01-11 21:17:49 +01:00
} else {
PortP - > ID2 = 0 ;
2006-03-24 12:18:32 +01:00
PortP - > SecondBlock = 0 ;
2005-04-17 00:20:36 +02:00
}
2006-01-11 21:17:49 +01:00
PortP - > RtaUniqueNum = HostMapP - > RtaUniqueNum ;
2005-04-17 00:20:36 +02:00
/*
2006-01-11 21:17:49 +01:00
* * If the port was already mapped then thats all we need to do .
*/
2005-04-17 00:20:36 +02:00
if ( PortP - > Mapped ) {
2006-01-11 21:17:49 +01:00
rio_spin_unlock_irqrestore ( & PortP - > portSem , flags ) ;
2005-04-17 00:20:36 +02:00
continue ;
2006-01-11 21:17:49 +01:00
} else
HostMapP - > Flags & = ~ RTA_NEWBOOT ;
2005-04-17 00:20:36 +02:00
2006-01-11 21:17:49 +01:00
PortP - > State = 0 ;
PortP - > Config = 0 ;
2005-04-17 00:20:36 +02:00
/*
2006-01-11 21:17:49 +01:00
* * Check out the module type - if it is special ( read only etc . )
* * then we need to set flags in the PortP - > Config .
* * Note : For 16 port RTA , all ports are of the same type .
*/
2005-04-17 00:20:36 +02:00
if ( RtaType = = TYPE_RTA16 ) {
2006-01-11 21:17:49 +01:00
PortP - > Config | = p - > RIOModuleTypes [ HostP - > UnixRups [ HostMapP - > ID - 1 ] . ModTypes ] . Flags [ SubEnt % PORTS_PER_MODULE ] ;
2005-04-17 00:20:36 +02:00
} else {
2006-01-11 21:17:49 +01:00
if ( SubEnt < PORTS_PER_MODULE )
PortP - > Config | = p - > RIOModuleTypes [ LONYBLE ( HostP - > UnixRups [ HostMapP - > ID - 1 ] . ModTypes ) ] . Flags [ SubEnt % PORTS_PER_MODULE ] ;
2005-04-17 00:20:36 +02:00
else
2006-01-11 21:17:49 +01:00
PortP - > Config | = p - > RIOModuleTypes [ HINYBLE ( HostP - > UnixRups [ HostMapP - > ID - 1 ] . ModTypes ) ] . Flags [ SubEnt % PORTS_PER_MODULE ] ;
2005-04-17 00:20:36 +02:00
}
/*
2006-01-11 21:17:49 +01:00
* * more port related flags
*/
PortP - > PortState = 0 ;
PortP - > ModemLines = 0 ;
PortP - > ModemState = 0 ;
PortP - > CookMode = COOK_WELL ;
PortP - > ParamSem = 0 ;
PortP - > FlushCmdBodge = 0 ;
PortP - > WflushFlag = 0 ;
PortP - > MagicFlags = 0 ;
PortP - > Lock = 0 ;
PortP - > Store = 0 ;
PortP - > FirstOpen = 1 ;
2005-04-17 00:20:36 +02:00
/*
2006-01-11 21:17:49 +01:00
* * Buffers ' n things
*/
PortP - > RxDataStart = 0 ;
PortP - > Cor2Copy = 0 ;
PortP - > Name = & HostMapP - > Name [ 0 ] ;
2005-04-17 00:20:36 +02:00
PortP - > statsGather = 0 ;
PortP - > txchars = 0 ;
PortP - > rxchars = 0 ;
PortP - > opens = 0 ;
PortP - > closes = 0 ;
PortP - > ioctls = 0 ;
2006-01-11 21:17:49 +01:00
if ( PortP - > TxRingBuffer )
2006-03-24 12:18:27 +01:00
memset ( PortP - > TxRingBuffer , 0 , p - > RIOBufferSize ) ;
2006-01-11 21:17:49 +01:00
else if ( p - > RIOBufferSize ) {
2006-03-24 12:18:27 +01:00
PortP - > TxRingBuffer = kmalloc ( p - > RIOBufferSize , GFP_KERNEL ) ;
memset ( PortP - > TxRingBuffer , 0 , p - > RIOBufferSize ) ;
2005-04-17 00:20:36 +02:00
}
2006-01-11 21:17:49 +01:00
PortP - > TxBufferOut = 0 ;
PortP - > TxBufferIn = 0 ;
PortP - > Debug = 0 ;
2005-04-17 00:20:36 +02:00
/*
2006-01-11 21:17:49 +01:00
* * LastRxTgl stores the state of the rx toggle bit for this
* * port , to be compared with the state of the next pkt received .
* * If the same , we have received the same rx pkt from the RTA
* * twice . Initialise to a value not equal to PHB_RX_TGL or 0.
*/
2006-03-24 12:18:27 +01:00
PortP - > LastRxTgl = ~ ( u8 ) PHB_RX_TGL ;
2005-04-17 00:20:36 +02:00
/*
2006-01-11 21:17:49 +01:00
* * and mark the port as usable
*/
2005-04-17 00:20:36 +02:00
PortP - > Mapped = 1 ;
rio_spin_unlock_irqrestore ( & PortP - > portSem , flags ) ;
}
2006-01-11 21:17:49 +01:00
if ( HostMapP - > SysPort < p - > RIOFirstPortsMapped )
2005-04-17 00:20:36 +02:00
p - > RIOFirstPortsMapped = HostMapP - > SysPort ;
2006-01-11 21:17:49 +01:00
if ( HostMapP - > SysPort > p - > RIOLastPortsMapped )
2005-04-17 00:20:36 +02:00
p - > RIOLastPortsMapped = HostMapP - > SysPort ;
return 0 ;
}
2006-03-24 12:18:27 +01:00
int RIOChangeName ( struct rio_info * p , struct Map * MapP )
2005-04-17 00:20:36 +02:00
{
int host ;
struct Map * HostMapP ;
char * sptr ;
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " Change name entry on host %x, rta %x, ID %d, Sysport %d \n " , MapP - > HostUniqueNum , MapP - > RtaUniqueNum , MapP - > ID , ( int ) MapP - > SysPort ) ;
2005-04-17 00:20:36 +02:00
2006-01-11 21:17:49 +01:00
if ( MapP - > ID > MAX_RUP ) {
rio_dprintk ( RIO_DEBUG_TABLE , " Bad ID in map entry! \n " ) ;
2005-04-17 00:20:36 +02:00
p - > RIOError . Error = ID_NUMBER_OUT_OF_RANGE ;
return - EINVAL ;
}
2006-01-11 21:17:49 +01:00
MapP - > Name [ MAX_NAME_LEN - 1 ] = ' \0 ' ;
2005-04-17 00:20:36 +02:00
sptr = MapP - > Name ;
2006-01-11 21:17:49 +01:00
while ( * sptr ) {
if ( * sptr < ' ' | | * sptr > ' ~ ' ) {
rio_dprintk ( RIO_DEBUG_TABLE , " Name entry contains non-printing characters! \n " ) ;
2005-04-17 00:20:36 +02:00
p - > RIOError . Error = BAD_CHARACTER_IN_NAME ;
return - EINVAL ;
}
sptr + + ;
}
2006-01-11 21:17:49 +01:00
for ( host = 0 ; host < p - > RIONumHosts ; host + + ) {
if ( MapP - > HostUniqueNum = = p - > RIOHosts [ host ] . UniqueNum ) {
if ( ( p - > RIOHosts [ host ] . Flags & RUN_STATE ) ! = RC_RUNNING ) {
2005-04-17 00:20:36 +02:00
p - > RIOError . Error = HOST_NOT_RUNNING ;
return - ENXIO ;
}
2006-01-11 21:17:49 +01:00
if ( MapP - > ID = = 0 ) {
2006-03-24 12:18:32 +01:00
memcpy ( p - > RIOHosts [ host ] . Name , MapP - > Name , MAX_NAME_LEN ) ;
2005-04-17 00:20:36 +02:00
return 0 ;
}
2006-01-11 21:17:49 +01:00
HostMapP = & p - > RIOHosts [ host ] . Mapping [ MapP - > ID - 1 ] ;
2005-04-17 00:20:36 +02:00
2006-01-11 21:17:49 +01:00
if ( HostMapP - > RtaUniqueNum ! = MapP - > RtaUniqueNum ) {
2005-04-17 00:20:36 +02:00
p - > RIOError . Error = RTA_NUMBER_WRONG ;
return - ENXIO ;
}
2006-03-24 12:18:32 +01:00
memcpy ( HostMapP - > Name , MapP - > Name , MAX_NAME_LEN ) ;
2005-04-17 00:20:36 +02:00
return 0 ;
}
}
p - > RIOError . Error = UNKNOWN_HOST_NUMBER ;
2006-01-11 21:17:49 +01:00
rio_dprintk ( RIO_DEBUG_TABLE , " Unknown host %x \n " , MapP - > HostUniqueNum ) ;
2005-04-17 00:20:36 +02:00
return - ENXIO ;
}