M:/USB-BDI/USB-BDI/Firmware/MPC555-USB-BDI/lib/isr.c

Go to the documentation of this file.

/*      USB-BDI Used for programming and debugging a MPC555 over USB
 * 
 *  Copyright 2005 NTB Interstate University of Applied Sciences of Technology Buchs
 *
 *  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 3 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.
 */

#include "isr.h"
#include "fx2regs.h"
#include "syncdelay.h"

extern __xdata unsigned char _standard_interrupt_vector[];
extern __xdata unsigned char _usb_autovector[];
extern __xdata unsigned char _fifo_gpif_autovector[];

#define LJMP_OPCODE     0x02


void hook_sv (unsigned char vector_number, unsigned short addr){
  __bit t;
  
  // sanity checks

  if (vector_number < SV_MIN || vector_number > SV_MAX)
    return;

  if ((vector_number & 0x0f) != 0x03 && (vector_number & 0x0f) != 0x0b)
    return;

  t = EA;
  EA = 0;
  _standard_interrupt_vector[vector_number] = LJMP_OPCODE;
  _standard_interrupt_vector[vector_number + 1] = addr >> 8;
  _standard_interrupt_vector[vector_number + 2] = addr & 0xff;
  EA = t;
}

void hook_uv (unsigned char vector_number, unsigned short addr){
  __bit t;
  
  // sanity checks

/*  if (vector_number < UV_MIN || vector_number > UV_MAX)
    return;*/

  if ((vector_number & 0x3) != 0)
    return;

  t = EA;
  EA = 0;
  _usb_autovector[vector_number] = LJMP_OPCODE;
  _usb_autovector[vector_number + 1] = addr >> 8;
  _usb_autovector[vector_number + 2] = addr & 0xff;
  EA = t;
}

void hook_fgv (unsigned char vector_number, unsigned short addr){
  __bit t;
  
  // sanity checks

  if (vector_number < FGV_MIN || vector_number > FGV_MAX)
    return;

  if ((vector_number & 0x3) != 0)
    return;

  t = EA;
  EA = 0;
  _fifo_gpif_autovector[vector_number] = LJMP_OPCODE;
  _fifo_gpif_autovector[vector_number + 1] = addr >> 8;
  _fifo_gpif_autovector[vector_number + 2] = addr & 0xff;
  EA = t;
}

void setup_autovectors (void) {
  // disable master usb and fifo/gpif interrupt enables
  EIUSB = 0;
  EIEX4 = 0;

  hook_sv (SV_INT_2, (unsigned short) _usb_autovector);
  hook_sv (SV_INT_4, (unsigned short) _fifo_gpif_autovector);

  // disable all fifo interrupt enables
  SYNCDELAY;
  EP2FIFOIE = 0;        SYNCDELAY;
  EP4FIFOIE = 0;        SYNCDELAY;
  EP6FIFOIE = 0;        SYNCDELAY;
  EP8FIFOIE = 0;        SYNCDELAY;

  // clear all pending fifo irqs        
  EP2FIFOIRQ = 0xff;    SYNCDELAY;
  EP4FIFOIRQ = 0xff;    SYNCDELAY;
  EP6FIFOIRQ = 0xff;    SYNCDELAY;
  EP8FIFOIRQ = 0xff;    SYNCDELAY;

  IBNIE  = 0;
  IBNIRQ = 0xff;
  NAKIE  = 0;
  NAKIRQ = 0xff;
  USBIE  = 0;
  USBIRQ = 0xff;
  EPIE   = 0;
  EPIRQ  = 0xff;
  SYNCDELAY;    GPIFIE = 0;             
  SYNCDELAY;    GPIFIRQ = 0xff;
  USBERRIE = 0;
  USBERRIRQ = 0xff;
  CLRERRCNT = 0;
  
  INTSETUP = bmAV2EN | bmAV4EN | bmINT4IN;

  // clear master irq's for usb and fifo/gpif
  EXIF &= ~bmEXIF_USBINT;
  EXIF &= ~bmEXIF_IE4;
  
  // enable master usb and fifo/gpif interrrupts
  EIUSB = 1;
  EIEX4 = 1;
}