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

void BDI_555_init()
{
        /* 
         * BDIddr (STATUS_LED2 STATUS_LED1 BERR DSCK DSDI DSDO HARD_RESET FREEZE)
         * 0 = input, 1 = output
         */
        BDIddr = BDIddrInit;    // 11000010
        BDIout = BDIoutInit;    // 00000010
}

void BDI_555_hard_reset()
{
        // set DSCK and DSDI as output to override the values of the TP3465 chip
        BDIddr = BDIddrInit | bmDSCK | bmDSDI;
        // Documentation: RCPU RM 8.4.1
        DSCK = 1;
        DSDI = 0;
        HARD_RESET = 0;
        mdelay(50);
        HARD_RESET = 1;
        mdelay(50);     // if we omit this delay, debug mode will not be enabled
        // set DSCK and DSDI as input
        BDIddr = BDIddrInit;
}


void BDI_555_35(){
        
#ifdef TIMEOUT_EXCEPTION_ON
        exceptionOnTimeoutOn();
        // wait for DSDO to go low
        while (DSDO) {
                // return if exception packet sent
                if (!exceptionOnTimeout) { return; }
        }
        exceptionOnTimeoutOff();
#endif

        // sending data to peripherals (hardware assisted chip select)
        // 1: write LOW byte data to SMB + HIGH byte to FMB(Dx)
        // MS Bit is transmitted first -> HIGH byte is sent first
        // 2: loop until uwdone bit is set

        //CKCON = 5;            // MOVX takes 9 cycles (583 ns @ 48MHz)

        // send first two bytes
        SMB = usbOutBuffer[outBufIndex + PACKET_DATA_OFFSET + 1];
        FMBD0 = usbOutBuffer[outBufIndex + PACKET_DATA_OFFSET];
        waitForUWDONE();
        usbInBuffer[inBufIndex + PACKET_DATA_OFFSET] = FMBD0;
        usbInBuffer[inBufIndex + PACKET_DATA_OFFSET + 1] = SMB;

        // send second two bytes
        SMB = usbOutBuffer[outBufIndex + PACKET_DATA_OFFSET + 3];
        FMBD0 = usbOutBuffer[outBufIndex + PACKET_DATA_OFFSET + 2];
        waitForUWDONE();
        usbInBuffer[inBufIndex + PACKET_DATA_OFFSET + 2] = FMBD0;
        usbInBuffer[inBufIndex + PACKET_DATA_OFFSET + 3] = SMB;

        // send last byte
        MWM = 0x00;     // set 8 bit operation
        FMBD0 = usbOutBuffer[outBufIndex + PACKET_DATA_OFFSET + 4];
        waitForUWDONE();
        usbInBuffer[inBufIndex + PACKET_DATA_OFFSET + 4] = FMBD0;
        MWM = 0xFF;     // set 16 bit operation

        // CKCON = 0;           // MOVX takes 2 cycles (41.7ns @ 48 MHz)
}


void BDI_555_10()
{
        signed char _bit;

#ifdef TIMEOUT_EXCEPTION_ON
        exceptionOnTimeoutOn();
        // wait for DSDO to go low
        while (DSDO) {
                // return if exception packet sent
                if (!exceptionOnTimeout) { return; }
        }
        exceptionOnTimeoutOff();
#endif
        // send/receive the first 8 bits
        for (_bit = 7; _bit >= 0; _bit--) {
                // read DSDO
                usbInBuffer[inBufIndex + PACKET_DATA_OFFSET] *= 2;      // shift left
                if (DSDO) {     // DSDO set
                        usbInBuffer[inBufIndex + PACKET_DATA_OFFSET] += 1;
                }
                // set DSDI
                if (usbOutBuffer[outBufIndex + PACKET_DATA_OFFSET] & (1<<_bit)) {       // bit set
                        DSDI = 1;
                } else {        // bit cleared
                        DSDI = 0;
                }
                // clock high
                DSCK = 1;
                // clock low
                DSCK = 0;
        }
        // send/receive the last 2 bits
        for (_bit = 1; _bit >= 0; _bit--) {
                // read DSDO
                usbInBuffer[inBufIndex + PACKET_DATA_OFFSET] *= 2;      // shift left
                if (DSDO) {     // DSDO set
                        usbInBuffer[inBufIndex + PACKET_DATA_OFFSET] += 1;
                }
                // set DSDI
                if (usbOutBuffer[outBufIndex + PACKET_DATA_OFFSET + BDI_10_OFFSET] & (1<<(_bit + 6))) { // bit set
                        DSDI = 1;
                } else {        // bit cleared
                        DSDI = 0;
                }
                // clock high
                DSCK = 1;
                // clock low
                DSCK = 0;
        }
        // shift bits (the 2 bits are right alligned -> shift left (msb))
        usbInBuffer[inBufIndex + PACKET_DATA_OFFSET] *= 64;     // shift left
}