ref: b7ee84c65da44dfed3d8ceca424da511b0c1412f
dir: /sys/src/9/ppc/mcc.c/
#include "u.h"
#include "../port/lib.h"
#include "mem.h"
#include "dat.h"
#include "fns.h"
#include "io.h"
#include "../port/error.h"
/*
*
* mcc.c
*
* This is the driver for the Multi-Channel Communications Controller
* of the MPC8260. This version is constructed for the EST SBC8260 to
* handle data from an interface to an offboard T1 framer. The driver
* supports MCC2 + TDM A:2 (channel 128) which is connected to the
* external interface.
*
* Neville Chandler
* Lucent Technologies - Bell Labs
* March 2001
*
*/
#define PKT_LEN 40
#define MPC82XX_INIT_DELAY 0x10000
#define HPIC 0xFC000000
#define HPIA 0xFC000010
#define HPID_A 0xFC000020
#define HPID 0xFC000030
#include "mcc2.h"
static ssize_t mcc2_read( struct file *, char *, size_t, loff_t * );
static ssize_t mcc2_write( struct file *, const char *, size_t, loff_t *);
static loff_t mcc2_lseek( struct file *, loff_t, int );
static int mcc2_release( struct inode *, struct file * );
static ssize_t mcc2_ioctl( struct inode *, struct file *, unsigned int, unsigned long );
//static ssize_t mcc2_ioctl( struct inode *, struct file *, unsigned int, char * );
void MPC82xxCpmInit( void );
void PortInit( void );
void PortSelectPin( unsigned short );
void InitMemAlloc( void );
void HeapCreate( U32, U32, U32, U32, char *);
void HeapCreate( U32, U32, U32, U32, char *);
void *HeapSearchMem( U32, U32);
void *HeapAllocMem( U32, U32);
void HeapFreeMem( U32, void *);
void InitLinkedList( void );
boolean DwCreateList( ListDB * );
void *DwMalloc( U32 );
void DwFree( U32, void * );
void ppc_irq_dispatch_handler(struct pt_regs *regs, int irq);
#define NR_MASK_WORDS ((NR_IRQS + 31) / 32)
extern int ppc_spurious_interrupts;
extern int ppc_second_irq;
extern struct irqaction *ppc_irq_action[NR_IRQS];
extern unsigned int ppc_local_bh_count[NR_CPUS];
extern unsigned int ppc_local_irq_count[NR_CPUS];
extern unsigned int ppc_cached_irq_mask[NR_MASK_WORDS];
extern unsigned int ppc_lost_interrupts[NR_MASK_WORDS];
extern atomic_t ppc_n_lost_interrupts;
//static void disp_led( unsigned char );
void Mcc2Init( void );
void MccDisable( unsigned char );
void MccEnable( unsigned char, unsigned char, unsigned char );
void MccRiscCmd( unsigned char, dwv_RISC_OPCODE, unsigned char );
boolean MccTest( void );
int MccTxBuffer( unsigned char, unsigned char, char *, unsigned short, unsigned short );
extern U32 PpcDisable( void );
extern void PpcMsrRestore( U32 );
static int mcc2_major = MCC_MAJOR;
static BOOLEAN insertBD_T( BD_PFIFO *, BD_P );
static BOOLEAN removBD_T( BD_PFIFO *, BD_P * );
BOOLEAN empty(volatile register FIFO *);
int insert( FIFO *, char * );
int remove( FIFO *, char ** );
void AppInit( void );
#define physaddr(ADDR) (0x60020000 | ((ADDR) << 23) | (2 << 18))
mcc_iorw_t mcc_iorw;
#if 0
typedef struct mcc_io {
unsigned int cmd;
unsigned int address;
unsigned int *buf;
int ind;
int nbytes;
siramctl_t SiRam;
cpmux_t CpMux;
mcc_t Mcc_T;
iop8260_t Io_Ports;
} mcc_iorw_t;
#endif
static void
ioctl_parm( unsigned int loop_mode )
{
/* Setup the SIMODE Register */
Si2Regs->SiAmr = SIxMR_SAD_BANK0_FIRST_HALF | /* SADx */
loop_mode | /* SDMx */
SIxMR_NO_BIT_RX_SYNC_DELAY | /* RFSDx */
SIxMR_DSC_CH_DATA_CLK_EQU | /* DSCx */
SIxMR_CRT_SPEPARATE_PINS | /* CRTx */
SIxMR_SLx_NORMAL_OPERATION | /* SLx */
SIxMR_CE_TX_RISING_RX_FALLING | /* CEx */
SIxMR_FE_FALLING_EDGE | /* FEx */
SIxMR_GM_GCI_SCIT_MODE | /* GMx */
SIxMR_NO_BIT_TX_SYNC_DELAY; /* TFSDx */
}
#if 0
static void
disp_led( unsigned char byte )
{
//int i;
*leds = byte;
//for(i=0; i<1000; i++);
}
#endif
static ssize_t
mcc2_ioctl( struct inode *inode, struct file *file,
unsigned int ioctl_cmd, // IOCTL number
unsigned long param )
// char *param ) // IOCTL parameter
{
static unsigned char mode;
char cp, *cptr;
void *vptr;
unsigned long *lptr;
int i, j;
unsigned int ld;
unsigned long lng;
volatile immap_t *Mmap;
cptr = (char *)param;
mode = (unsigned char)*cptr;
Mmap = ((volatile immap_t *)IMAP_ADDR);
switch(ioctl_cmd)
{
case IOCTL_SET_MODE:
//mode = (unsigned char)*param;
mode = ((mcc_iorw_t *)param)->cmd;
switch( mode )
{
case NORMAL_OPERATION:
/* Setup the SIMODE Register */
D( printk("mcc2_ioctl: ioctl set NORMAL_OPERATION mode\n"); )
ioctl_parm( (unsigned int)SIxMR_SDM_NORMAL_OPERATION ); /* SDMx */
break;
case AUTOMATIC_ECHO:
/* Setup the SIMODE Register */
D( printk("mcc2_ioctl: ioctl set AUTOMATIC_ECHO mode\n"); )
ioctl_parm( (unsigned int)SIxMR_SDM_AUTOMATIC_ECHO ); /* SDMx */
break;
case INTERNAL_LOOPBACK:
/* Setup the SIMODE Register */
D( printk("mcc2_ioctl: ioctl set INTERNAL_LOOPBACK mode\n"); )
ioctl_parm( (unsigned int)SIxMR_SDM_INTERNAL_LOOPBACK ); /* SDMx */
break;
case LOOPBACK_CONTROL:
/* Setup the SIMODE Register */
D( printk("mcc2_ioctl: ioctl set LOOPBACK_CONTROL mode\n"); )
ioctl_parm( (unsigned int)SIxMR_SDM_LOOPBACK_CONTROL ); /* SDMx */
break;
default:
printk("mcc2_ioctl: Error, unrecognized ioctl parameter, device operation unchanged.\n");
break;
}
break;
case IOCTL_RWX_MODE:
mode = ((mcc_iorw_t *)param)->cmd;
switch(mode)
{
case HPI_RD:
lng = (long)(((mcc_iorw_t *)param)->address);
lptr = ((unsigned long *)lng);
vptr = (void *)lptr;
if (copy_to_user( (((mcc_iorw_t *)param)->buf), (void *)vptr, (((mcc_iorw_t *)param)->nbytes))) {
printk("mcc2_ioctl: Failed during read from hpi.\n");
return -EFAULT;
}
break;
case HPI_WR:
lng = (long)(((mcc_iorw_t *)param)->address);
lptr = ((unsigned long *)lng);
vptr = (void *)lptr;
if (copy_from_user( (void *)vptr, (((mcc_iorw_t *)param)->buf), (((mcc_iorw_t *)param)->nbytes))) {
printk("mcc2_ioctl: Failed during write to hpi\n");
return -EFAULT;
}
break;
case FPGA_RD:
lng = (long)(((mcc_iorw_t *)param)->address);
lptr = ((unsigned long *)lng);
vptr = (void *)lptr;
if (copy_to_user( (((mcc_iorw_t *)param)->buf), (void *)vptr, (((mcc_iorw_t *)param)->nbytes))) {
printk("mcc2_ioctl: Failed during read from FPGA.\n");
return -EFAULT;
}
break;
case FPGA_WR:
lng = (long)(((mcc_iorw_t *)param)->address);
lptr = ((unsigned long *)lng);
vptr = (void *)lptr;
if (copy_from_user( (void *)vptr, (((mcc_iorw_t *)param)->buf), (((mcc_iorw_t *)param)->nbytes))) {
printk("mcc2_ioctl: Failed during write to FPGA\n");
return -EFAULT;
}
break;
case MEM_MODR:
cptr = (char *)Mmap;
cptr += ((mcc_iorw_t *)param)->address;
if (copy_to_user( (((mcc_iorw_t *)param)->buf), (void *)cptr, (((mcc_iorw_t *)param)->nbytes))) {
printk("mcc2_ioctl: Failed during read of read-modify memory\n");
return -EFAULT;
}
break;
case MEM_MODW:
cptr = (char *)Mmap;
cptr += ((mcc_iorw_t *)param)->address;
if (copy_from_user( (void *)cptr, (((mcc_iorw_t *)param)->buf), (((mcc_iorw_t *)param)->nbytes))) {
printk("mcc2_ioctl: Failed during modify of read-modify memory\n");
return -EFAULT;
}
break;
case IO_PORTS:
break;
case SI_RAM_CTL1:
break;
case SI_RAM_CTL2:
if (copy_to_user( (void *)param, (siramctl_t *)&(Mmap->im_siramctl2), sizeof(siramctl_t))) {
printk("mcc2_ioctl: Failed to copy SI_RAM_CTL2 struct\n");
return -EFAULT;
}
break;
default:
break;
}
break;
default:
//if (copy_to_user((void *)param, &mode, sizeof(mode)))
printk("We are at the end ...\n");
return -EFAULT;
break;
}
break;
default:
break;
}
return 0;
}
////////////////////////////////////////////////////////////////////////////////
//
////////////////////////////////////////////////////////////////////////////////
static ssize_t
mcc2_open( struct inode *inode, struct file *file )
{
MOD_INC_USE_COUNT;
return 0;
}
////////////////////////////////////////////////////////////////////////////////
//
////////////////////////////////////////////////////////////////////////////////
static int
mcc2_release( struct inode *inode, struct file *file )
{
MOD_DEC_USE_COUNT;
return 0;
}
#ifndef MODULE
////////////////////////////////////////////////////////////////////////////////
//
////////////////////////////////////////////////////////////////////////////////
long
mcc2_init( long mem_start, long mem_end )
{
if ((mcc2_major = register_chrdev(MCC_MAJOR, MCC_NAME, &mcc2_fops)))
printk("mcc2_init: Unable to get major for mcc2 device %d\n", MCC_MAJOR);
else {
//MPC82xxSiuInit();
MPC82xxCpmInit();
}
return mem_start;
}
#else