M:/USB-BDI/USB-BDI/Firmware/MPC555-USB-BDI/src/BDI.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 "usbpdi_common.h"
#include "usbpdi_main.h"
#include "delay.h"
#include "TP3465regs.h"

volatile __bit exceptionOnTimeout;
volatile unsigned char exceptionCount;
unsigned short outBufIndex;     //
unsigned short inBufIndex;      //


void initTP3465(){
        // init TP3465
        PD = 0xFF;              // set all CS pins to inputs
        SKP = 0x00;             // set SK polarity to normal mode
        MWM = 0xFF;             // set 16 bit operation
        SKR = 0x02;             // inten = 0, soi = 0, ms = 0, div = 0x2 (12Mhz/4=3Mhz)
}

void initBDI(){
        // disable (reset) timeouts
        exceptionOnTimeout = FALSE;
        // configure end points
        EP2CFG = bmVALID | bmBULK | bmDOUBLEBUF;        // 512 double bulk OUT
        SYNCDELAY;
        EP6CFG = bmVALID | bmBULK | bmDOUBLEBUF | bmIN; // 512 double bulk IN
        SYNCDELAY;

        // reset FIFOs
        FIFORESET = bmNAKALL;
        SYNCDELAY;
        FIFORESET = 2;
        SYNCDELAY;
        FIFORESET = 6;
        SYNCDELAY;

        // since the fifos are double buffered we must write dummy byte counts twice
        // NOTE: ONLY write 0x80, other values don't work!
        // This is wrong in the TRM!
        EP2BCL = 0x80;                                  // arm EP2OUT by writing byte count w/skip. Endpoint 2 Byte Count Low Registers
        SYNCDELAY;
        EP2BCL = 0x80;
        SYNCDELAY;
}
void exceptionOnTimeoutOn(){
        exceptionCount = 0;
        exceptionOnTimeout = TRUE;
}
void exceptionOnTimeoutOff(){
        exceptionOnTimeout = FALSE;
}
void BDI_get_freeze(){
        usbInBuffer[inBufIndex + PACKET_DATA_OFFSET] = FREEZE;
}
void sendPacket(unsigned short dataLength){
        EP6BCH = MSB(dataLength + PACKET_MIN_LENGTH);
        SYNCDELAY;
        EP6BCL = LSB(dataLength + PACKET_MIN_LENGTH);  // arm EP6IN
        SYNCDELAY;
        inBufIndex = 0; // reset inBufIndex
}
void handelBDIPackages(){
        __bit finished;

        unsigned short length, outBufferCount;//, uart0OutBufferLen, i;
        // if there is new data in EP2FIFOBUF and EP6IN is not full then process data
        if(!(EP2468STAT & bmEP2EMPTY)){ // if true packages from host are available
                if(!(EP2468STAT & bmEP6FULL)){ //Tests if Endpoint 6 Buffer is not full if true = data can be sent to Host
                        outBufferCount = (EP2BCH << 8) + EP2BCL;        // get length of data that are send from the host
                        outBufIndex = 0;                                                        // reset outBufIndex
                        finished = FALSE;
                        // process data
                        while (!finished) {
                        // check header bytes
                                if ((usbOutBuffer[outBufIndex] == PACKET_HEADER)) {     // Test if the rigth header code was sent if not send a error
                                        length = usbOutBuffer[outBufIndex + 3] * 0x100 + usbOutBuffer[outBufIndex + 4];
                                        if (usbOutBuffer[outBufIndex + 5 + length] == PACKET_END) {     // success test if the right length was found
                                                dispatch(length);
                                                outBufIndex += length + PACKET_MIN_LENGTH;
                                                if (outBufIndex >= outBufferCount) { //Test if all packages were worked thru else do loop again
                                                        finished = TRUE;
                                                }
                                        } else {        // fail send error msg
                                                initPacket(MTYPE_ERROR, STYPE_ERROR_PACKET_END, 0);
                                                // send packet
                                                sendPacket(0);
                                                finished = TRUE;
                                        }
                                } else { // fail send a error msg
                                        initPacket(MTYPE_ERROR, STYPE_ERROR_HEADER, 0);
                                        // send packet
                                        sendPacket(0);
                                        finished = TRUE;
                                }
                        }
                        // rearm for new packet
                        EP2BCL = 0x80;                  // re(arm) EP2OUT
                        SYNCDELAY;
                }
        }
}