17 files changed, 3389 insertions, 3389 deletions

diff --git a/Projects/AVRISP-MKII/Lib/ISP/ISPProtocol.c b/Projects/AVRISP-MKII/Lib/ISP/ISPProtocol.c
index 9d0a26c33..a16504da1 100644
--- a/Projects/AVRISP-MKII/Lib/ISP/ISPProtocol.c
+++ b/Projects/AVRISP-MKII/Lib/ISP/ISPProtocol.c
@@ -1,545 +1,545 @@
-/*

-             LUFA Library

-     Copyright (C) Dean Camera, 2010.

-              

-  dean [at] fourwalledcubicle [dot] com

-      www.fourwalledcubicle.com

-*/

-

-/*

-  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)

-

-  Permission to use, copy, modify, distribute, and sell this 

-  software and its documentation for any purpose is hereby granted

-  without fee, provided that the above copyright notice appear in 

-  all copies and that both that the copyright notice and this

-  permission notice and warranty disclaimer appear in supporting 

-  documentation, and that the name of the author not be used in 

-  advertising or publicity pertaining to distribution of the 

-  software without specific, written prior permission.

-

-  The author disclaim all warranties with regard to this

-  software, including all implied warranties of merchantability

-  and fitness.  In no event shall the author be liable for any

-  special, indirect or consequential damages or any damages

-  whatsoever resulting from loss of use, data or profits, whether

-  in an action of contract, negligence or other tortious action,

-  arising out of or in connection with the use or performance of

-  this software.

-*/

-

-/** \file

- *

- *  ISP Protocol handler, to process V2 Protocol wrapped ISP commands used in Atmel programmer devices.

- */

-

-#include "ISPProtocol.h"

-

-#if defined(ENABLE_ISP_PROTOCOL) || defined(__DOXYGEN__)

-

-/** Handler for the CMD_ENTER_PROGMODE_ISP command, which attempts to enter programming mode on

- *  the attached device, returning success or failure back to the host.

- */

-void ISPProtocol_EnterISPMode(void)

-{

-	struct

-	{

-		uint8_t TimeoutMS;

-		uint8_t PinStabDelayMS;

-		uint8_t ExecutionDelayMS;

-		uint8_t SynchLoops;

-		uint8_t ByteDelay;

-		uint8_t PollValue;

-		uint8_t PollIndex;

-		uint8_t EnterProgBytes[4];

-	} Enter_ISP_Params;

-	

-	Endpoint_Read_Stream_LE(&Enter_ISP_Params, sizeof(Enter_ISP_Params), NO_STREAM_CALLBACK);

-

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-

-	uint8_t ResponseStatus = STATUS_CMD_FAILED;

-	

-	CurrentAddress = 0;

-	

-	/* Set up the synchronous USART to generate the recovery clock on XCK pin */

-	UBRR1  = (F_CPU / 500000UL);

-	UCSR1B = (1 << TXEN1);

-	UCSR1C = (1 << UMSEL10) | (1 << UPM11) | (1 << USBS1) | (1 << UCSZ11) | (1 << UCSZ10) | (1 << UCPOL1);

-	DDRD  |= (1 << 5);

-

-	/* Perform execution delay, initialize SPI bus */

-	ISPProtocol_DelayMS(Enter_ISP_Params.ExecutionDelayMS); 

-	SPI_Init(ISPTarget_GetSPIPrescalerMask() | SPI_SCK_LEAD_RISING | SPI_SAMPLE_LEADING | SPI_MODE_MASTER);

-

-	/* Continuously attempt to synchronize with the target until either the number of attempts specified

-	 * by the host has exceeded, or the the device sends back the expected response values */

-	while (Enter_ISP_Params.SynchLoops-- && (ResponseStatus == STATUS_CMD_FAILED) && TimeoutMSRemaining)

-	{

-		uint8_t ResponseBytes[4];

-

-		ISPTarget_ChangeTargetResetLine(true);

-		ISPProtocol_DelayMS(Enter_ISP_Params.PinStabDelayMS);

-

-		for (uint8_t RByte = 0; RByte < sizeof(ResponseBytes); RByte++)

-		{

-			ISPProtocol_DelayMS(Enter_ISP_Params.ByteDelay);

-			ResponseBytes[RByte] = SPI_TransferByte(Enter_ISP_Params.EnterProgBytes[RByte]);

-		}

-		

-		/* Check if polling disabled, or if the polled value matches the expected value */

-		if (!(Enter_ISP_Params.PollIndex) || (ResponseBytes[Enter_ISP_Params.PollIndex - 1] == Enter_ISP_Params.PollValue))

-		{

-			ResponseStatus = STATUS_CMD_OK;

-		}

-		else

-		{

-			ISPTarget_ChangeTargetResetLine(false);

-			ISPProtocol_DelayMS(Enter_ISP_Params.PinStabDelayMS);

-		}

-	}

-

-	Endpoint_Write_Byte(CMD_ENTER_PROGMODE_ISP);

-	Endpoint_Write_Byte(ResponseStatus);

-	Endpoint_ClearIN();

-}

-

-/** Handler for the CMD_LEAVE_ISP command, which releases the target from programming mode. */

-void ISPProtocol_LeaveISPMode(void)

-{

-	struct

-	{

-		uint8_t PreDelayMS;

-		uint8_t PostDelayMS;

-	} Leave_ISP_Params;

-

-	Endpoint_Read_Stream_LE(&Leave_ISP_Params, sizeof(Leave_ISP_Params), NO_STREAM_CALLBACK);

-	

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-

-	/* Perform pre-exit delay, release the target /RESET, disable the SPI bus and perform the post-exit delay */

-	ISPProtocol_DelayMS(Leave_ISP_Params.PreDelayMS);

-	ISPTarget_ChangeTargetResetLine(false);

-	SPI_ShutDown();

-	ISPProtocol_DelayMS(Leave_ISP_Params.PostDelayMS);

-

-	/* Turn off the synchronous USART to terminate the recovery clock on XCK pin */

-	UBRR1  = (F_CPU / 500000UL);

-	UCSR1B = (1 << TXEN1);

-	UCSR1C = (1 << UMSEL10) | (1 << UPM11) | (1 << USBS1) | (1 << UCSZ11) | (1 << UCSZ10) | (1 << UCPOL1);

-	DDRD  &= ~(1 << 5);

-

-	Endpoint_Write_Byte(CMD_LEAVE_PROGMODE_ISP);

-	Endpoint_Write_Byte(STATUS_CMD_OK);

-	Endpoint_ClearIN();

-}

-

-/** Handler for the CMD_PROGRAM_FLASH_ISP and CMD_PROGRAM_EEPROM_ISP commands, writing out bytes,

- *  words or pages of data to the attached device.

- *

- *  \param[in] V2Command  Issued V2 Protocol command byte from the host

- */

-void ISPProtocol_ProgramMemory(uint8_t V2Command)

-{

-	struct

-	{

-		uint16_t BytesToWrite;

-		uint8_t  ProgrammingMode;

-		uint8_t  DelayMS;

-		uint8_t  ProgrammingCommands[3];

-		uint8_t  PollValue1;

-		uint8_t  PollValue2;

-		uint8_t  ProgData[256]; // Note, the Jungo driver has a very short ACK timeout period, need to buffer the

-	} Write_Memory_Params;      // whole page and ACK the packet as fast as possible to prevent it from aborting

-	

-	Endpoint_Read_Stream_LE(&Write_Memory_Params, (sizeof(Write_Memory_Params) -

-	                                               sizeof(Write_Memory_Params.ProgData)), NO_STREAM_CALLBACK);

-

-

-	Write_Memory_Params.BytesToWrite = SwapEndian_16(Write_Memory_Params.BytesToWrite);

-	

-	if (Write_Memory_Params.BytesToWrite > sizeof(Write_Memory_Params.ProgData))

-	{

-		Endpoint_ClearOUT();

-		Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-		Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-

-		Endpoint_Write_Byte(V2Command);

-		Endpoint_Write_Byte(STATUS_CMD_FAILED);

-		Endpoint_ClearIN();

-		return;

-	}

-	

-	Endpoint_Read_Stream_LE(&Write_Memory_Params.ProgData, Write_Memory_Params.BytesToWrite, NO_STREAM_CALLBACK);

-

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-

-	uint8_t  ProgrammingStatus = STATUS_CMD_OK;	

-	uint16_t PollAddress       = 0;

-	uint8_t  PollValue         = (V2Command == CMD_PROGRAM_FLASH_ISP) ? Write_Memory_Params.PollValue1 :

-	                                                                    Write_Memory_Params.PollValue2;

-	uint8_t* NextWriteByte = Write_Memory_Params.ProgData;

-

-	/* Check to see if the host has issued a SET ADDRESS command and we haven't sent a

-	 * LOAD EXTENDED ADDRESS command (if needed, used when operating beyond the 128KB

-	 * FLASH barrier) */

-	if (MustSetAddress)

-	{

-		if (CurrentAddress & (1UL << 31))

-		  ISPTarget_LoadExtendedAddress();

-

-		MustSetAddress = false;

-	}

-

-	/* Check the programming mode desired by the host, either Paged or Word memory writes */

-	if (Write_Memory_Params.ProgrammingMode & PROG_MODE_PAGED_WRITES_MASK)

-	{

-		uint16_t StartAddress = (CurrentAddress & 0xFFFF);

-	

-		/* Paged mode memory programming */

-		for (uint16_t CurrentByte = 0; CurrentByte < Write_Memory_Params.BytesToWrite; CurrentByte++)

-		{

-			bool    IsOddByte   = (CurrentByte & 0x01);

-			uint8_t ByteToWrite = *(NextWriteByte++);

-		

-			SPI_SendByte(Write_Memory_Params.ProgrammingCommands[0]);

-			SPI_SendByte(CurrentAddress >> 8);

-			SPI_SendByte(CurrentAddress & 0xFF);

-			SPI_SendByte(ByteToWrite);

-			

-			/* AVR FLASH addressing requires us to modify the write command based on if we are writing a high

-			 * or low byte at the current word address */

-			if (V2Command == CMD_PROGRAM_FLASH_ISP)

-			  Write_Memory_Params.ProgrammingCommands[0] ^= READ_WRITE_HIGH_BYTE_MASK;

-

-			/* Check to see the write completion method, to see if we have a valid polling address */

-			if (!(PollAddress) && (ByteToWrite != PollValue))

-			{

-				if (IsOddByte && (V2Command == CMD_PROGRAM_FLASH_ISP))

-				  Write_Memory_Params.ProgrammingCommands[2] |= READ_WRITE_HIGH_BYTE_MASK;

-

-				PollAddress = (CurrentAddress & 0xFFFF);				

-			}		

-

-			if (IsOddByte || (V2Command == CMD_PROGRAM_EEPROM_ISP))

-			  CurrentAddress++;

-		}

-		

-		/* If the current page must be committed, send the PROGRAM PAGE command to the target */

-		if (Write_Memory_Params.ProgrammingMode & PROG_MODE_COMMIT_PAGE_MASK)

-		{

-			SPI_SendByte(Write_Memory_Params.ProgrammingCommands[1]);

-			SPI_SendByte(StartAddress >> 8);

-			SPI_SendByte(StartAddress & 0xFF);

-			SPI_SendByte(0x00);

-			

-			/* Check if polling is possible, if not switch to timed delay mode */

-			if (!(PollAddress))

-			{

-				Write_Memory_Params.ProgrammingMode &= ~PROG_MODE_PAGED_VALUE_MASK;

-				Write_Memory_Params.ProgrammingMode |=  PROG_MODE_PAGED_TIMEDELAY_MASK;				

-			}

-

-			ProgrammingStatus = ISPTarget_WaitForProgComplete(Write_Memory_Params.ProgrammingMode, PollAddress, PollValue,

-			                                                  Write_Memory_Params.DelayMS, Write_Memory_Params.ProgrammingCommands[2]);

-		}

-	}

-	else

-	{

-		/* Word/byte mode memory programming */

-		for (uint16_t CurrentByte = 0; CurrentByte < Write_Memory_Params.BytesToWrite; CurrentByte++)

-		{

-			bool    IsOddByte   = (CurrentByte & 0x01);

-			uint8_t ByteToWrite = *(NextWriteByte++);

-			  

-			SPI_SendByte(Write_Memory_Params.ProgrammingCommands[0]);

-			SPI_SendByte(CurrentAddress >> 8);

-			SPI_SendByte(CurrentAddress & 0xFF);

-			SPI_SendByte(ByteToWrite);

-			

-			/* AVR FLASH addressing requires us to modify the write command based on if we are writing a high

-			 * or low byte at the current word address */

-			if (V2Command == CMD_PROGRAM_FLASH_ISP)

-			  Write_Memory_Params.ProgrammingCommands[0] ^= READ_WRITE_HIGH_BYTE_MASK;

-

-			if (ByteToWrite != PollValue)

-			{

-				if (IsOddByte && (V2Command == CMD_PROGRAM_FLASH_ISP))

-				  Write_Memory_Params.ProgrammingCommands[2] |= READ_WRITE_HIGH_BYTE_MASK;

-				  

-				PollAddress = (CurrentAddress & 0xFFFF);

-			}

-

-			if (IsOddByte || (V2Command == CMD_PROGRAM_EEPROM_ISP))

-			  CurrentAddress++;

-			

-			ProgrammingStatus = ISPTarget_WaitForProgComplete(Write_Memory_Params.ProgrammingMode, PollAddress, PollValue,

-			                                                  Write_Memory_Params.DelayMS, Write_Memory_Params.ProgrammingCommands[2]);

-			  

-			if (ProgrammingStatus != STATUS_CMD_OK)

-			  break;

-		}

-	}

-

-	Endpoint_Write_Byte(V2Command);

-	Endpoint_Write_Byte(ProgrammingStatus);

-	Endpoint_ClearIN();

-}

-

-/** Handler for the CMD_READ_FLASH_ISP and CMD_READ_EEPROM_ISP commands, reading in bytes,

- *  words or pages of data from the attached device.

- *

- *  \param[in] V2Command  Issued V2 Protocol command byte from the host

- */

-void ISPProtocol_ReadMemory(uint8_t V2Command)

-{

-	struct

-	{

-		uint16_t BytesToRead;

-		uint8_t  ReadMemoryCommand;

-	} Read_Memory_Params;

-	

-	Endpoint_Read_Stream_LE(&Read_Memory_Params, sizeof(Read_Memory_Params), NO_STREAM_CALLBACK);

-	Read_Memory_Params.BytesToRead = SwapEndian_16(Read_Memory_Params.BytesToRead);

-	

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-	

-	Endpoint_Write_Byte(V2Command);

-	Endpoint_Write_Byte(STATUS_CMD_OK);

-	

-	/* Check to see if the host has issued a SET ADDRESS command and we haven't sent a

-	 * LOAD EXTENDED ADDRESS command (if needed, used when operating beyond the 128KB

-	 * FLASH barrier) */

-	if (MustSetAddress)

-	{

-		if (CurrentAddress & (1UL << 31))

-		  ISPTarget_LoadExtendedAddress();

-

-		MustSetAddress = false;

-	}

-

-	/* Read each byte from the device and write them to the packet for the host */

-	for (uint16_t CurrentByte = 0; CurrentByte < Read_Memory_Params.BytesToRead; CurrentByte++)

-	{

-		/* Read the next byte from the desired memory space in the device */

-		SPI_SendByte(Read_Memory_Params.ReadMemoryCommand);

-		SPI_SendByte(CurrentAddress >> 8);

-		SPI_SendByte(CurrentAddress & 0xFF);

-		Endpoint_Write_Byte(SPI_ReceiveByte());

-		

-		/* Check if the endpoint bank is currently full, if so send the packet */

-		if (!(Endpoint_IsReadWriteAllowed()))

-		{

-			Endpoint_ClearIN();

-			Endpoint_WaitUntilReady();

-		}

-		

-		/* AVR FLASH addressing requires us to modify the read command based on if we are reading a high

-		 * or low byte at the current word address */

-		if (V2Command == CMD_READ_FLASH_ISP)

-		  Read_Memory_Params.ReadMemoryCommand ^= READ_WRITE_HIGH_BYTE_MASK;

-

-		/* Only increment the current address if we have read both bytes in the current word when in FLASH

-		 * read mode, or for each byte when in EEPROM read mode */		 

-		if (((CurrentByte & 0x01) && (V2Command == CMD_READ_FLASH_ISP)) || (V2Command == CMD_READ_EEPROM_ISP))

-		  CurrentAddress++;

-	}

-

-	Endpoint_Write_Byte(STATUS_CMD_OK);

-

-	bool IsEndpointFull = !(Endpoint_IsReadWriteAllowed());

-	Endpoint_ClearIN();

-	

-	/* Ensure last packet is a short packet to terminate the transfer */

-	if (IsEndpointFull)

-	{

-		Endpoint_WaitUntilReady();	

-		Endpoint_ClearIN();

-		Endpoint_WaitUntilReady();	

-	}

-}

-

-/** Handler for the CMD_CHI_ERASE_ISP command, clearing the target's FLASH memory. */

-void ISPProtocol_ChipErase(void)

-{

-	struct

-	{

-		uint8_t EraseDelayMS;

-		uint8_t PollMethod;

-		uint8_t EraseCommandBytes[4];

-	} Erase_Chip_Params;

-	

-	Endpoint_Read_Stream_LE(&Erase_Chip_Params, sizeof(Erase_Chip_Params), NO_STREAM_CALLBACK);

-	

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-	

-	uint8_t ResponseStatus = STATUS_CMD_OK;

-	

-	/* Send the chip erase commands as given by the host to the device */

-	for (uint8_t SByte = 0; SByte < sizeof(Erase_Chip_Params.EraseCommandBytes); SByte++)

-	  SPI_SendByte(Erase_Chip_Params.EraseCommandBytes[SByte]);

-

-	/* Use appropriate command completion check as given by the host (delay or busy polling) */

-	if (!(Erase_Chip_Params.PollMethod))

-	  ISPProtocol_DelayMS(Erase_Chip_Params.EraseDelayMS);

-	else

-	  ResponseStatus = ISPTarget_WaitWhileTargetBusy();

-	  

-	Endpoint_Write_Byte(CMD_CHIP_ERASE_ISP);

-	Endpoint_Write_Byte(ResponseStatus);

-	Endpoint_ClearIN();

-}

-

-/** Handler for the CMD_READ_FUSE_ISP, CMD_READ_LOCK_ISP, CMD_READ_SIGNATURE_ISP and CMD_READ_OSCCAL commands,

- *  reading the requested configuration byte from the device.

- *

- *  \param[in] V2Command  Issued V2 Protocol command byte from the host

- */

-void ISPProtocol_ReadFuseLockSigOSCCAL(uint8_t V2Command)

-{

-	struct

-	{

-		uint8_t RetByte;

-		uint8_t ReadCommandBytes[4];

-	} Read_FuseLockSigOSCCAL_Params;

-	

-	Endpoint_Read_Stream_LE(&Read_FuseLockSigOSCCAL_Params, sizeof(Read_FuseLockSigOSCCAL_Params), NO_STREAM_CALLBACK);

-

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-

-	uint8_t ResponseBytes[4];

-

-	/* Send the Fuse or Lock byte read commands as given by the host to the device, store response */

-	for (uint8_t RByte = 0; RByte < sizeof(ResponseBytes); RByte++)

-	  ResponseBytes[RByte] = SPI_TransferByte(Read_FuseLockSigOSCCAL_Params.ReadCommandBytes[RByte]);

-		

-	Endpoint_Write_Byte(V2Command);

-	Endpoint_Write_Byte(STATUS_CMD_OK);

-	Endpoint_Write_Byte(ResponseBytes[Read_FuseLockSigOSCCAL_Params.RetByte - 1]);

-	Endpoint_Write_Byte(STATUS_CMD_OK);

-	Endpoint_ClearIN();

-}

-

-/** Handler for the CMD_WRITE_FUSE_ISP and CMD_WRITE_LOCK_ISP commands, writing the requested configuration

- *  byte to the device.

- *

- *  \param[in] V2Command  Issued V2 Protocol command byte from the host

- */

-void ISPProtocol_WriteFuseLock(uint8_t V2Command)

-{

-	struct

-	{

-		uint8_t WriteCommandBytes[4];

-	} Write_FuseLockSig_Params;

-	

-	Endpoint_Read_Stream_LE(&Write_FuseLockSig_Params, sizeof(Write_FuseLockSig_Params), NO_STREAM_CALLBACK);

-

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-

-	/* Send the Fuse or Lock byte program commands as given by the host to the device */

-	for (uint8_t SByte = 0; SByte < sizeof(Write_FuseLockSig_Params.WriteCommandBytes); SByte++)

-	  SPI_SendByte(Write_FuseLockSig_Params.WriteCommandBytes[SByte]);

-		

-	Endpoint_Write_Byte(V2Command);

-	Endpoint_Write_Byte(STATUS_CMD_OK);

-	Endpoint_Write_Byte(STATUS_CMD_OK);

-	Endpoint_ClearIN();

-}

-

-/** Handler for the CMD_SPI_MULTI command, writing and reading arbitrary SPI data to and from the attached device. */

-void ISPProtocol_SPIMulti(void)

-{

-	struct

-	{

-		uint8_t TxBytes;

-		uint8_t RxBytes;

-		uint8_t RxStartAddr;

-		uint8_t TxData[255];

-	} SPI_Multi_Params;

-	

-	Endpoint_Read_Stream_LE(&SPI_Multi_Params, (sizeof(SPI_Multi_Params) - sizeof(SPI_Multi_Params.TxData)), NO_STREAM_CALLBACK);

-	Endpoint_Read_Stream_LE(&SPI_Multi_Params.TxData, SPI_Multi_Params.TxBytes, NO_STREAM_CALLBACK);

-	

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-	

-	Endpoint_Write_Byte(CMD_SPI_MULTI);

-	Endpoint_Write_Byte(STATUS_CMD_OK);

-

-	uint8_t CurrTxPos = 0;

-	uint8_t CurrRxPos = 0;

-

-	/* Write out bytes to transmit until the start of the bytes to receive is met */

-	while (CurrTxPos < SPI_Multi_Params.RxStartAddr)

-	{

-		if (CurrTxPos < SPI_Multi_Params.TxBytes)

-		  SPI_SendByte(SPI_Multi_Params.TxData[CurrTxPos]);

-		else

-		  SPI_SendByte(0);

-		

-		CurrTxPos++;

-	}

-

-	/* Transmit remaining bytes with padding as needed, read in response bytes */

-	while (CurrRxPos < SPI_Multi_Params.RxBytes)

-	{

-		if (CurrTxPos < SPI_Multi_Params.TxBytes)

-		  Endpoint_Write_Byte(SPI_TransferByte(SPI_Multi_Params.TxData[CurrTxPos++]));

-		else

-		  Endpoint_Write_Byte(SPI_ReceiveByte());

-		  

-		/* Check to see if we have filled the endpoint bank and need to send the packet */

-		if (!(Endpoint_IsReadWriteAllowed()))

-		{

-			Endpoint_ClearIN();

-			Endpoint_WaitUntilReady();

-		}

-		

-		CurrRxPos++;

-	}	

-	

-	Endpoint_Write_Byte(STATUS_CMD_OK);

-

-	bool IsEndpointFull = !(Endpoint_IsReadWriteAllowed());

-	Endpoint_ClearIN();

-	

-	/* Ensure last packet is a short packet to terminate the transfer */

-	if (IsEndpointFull)

-	{

-		Endpoint_WaitUntilReady();	

-		Endpoint_ClearIN();

-		Endpoint_WaitUntilReady();	

-	}

-}

-

-/** Blocking delay for a given number of milliseconds.

- *

- *  \param[in] DelayMS  Number of milliseconds to delay for

- */

-void ISPProtocol_DelayMS(uint8_t DelayMS)

-{

-	while (DelayMS-- && TimeoutMSRemaining)

-	{

-		if (TimeoutMSRemaining)

-		  TimeoutMSRemaining--;

-		  

-		_delay_ms(1);

-	}

-}

-

+/*
+             LUFA Library
+     Copyright (C) Dean Camera, 2010.
+              
+  dean [at] fourwalledcubicle [dot] com
+      www.fourwalledcubicle.com
+*/
+
+/*
+  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)
+
+  Permission to use, copy, modify, distribute, and sell this 
+  software and its documentation for any purpose is hereby granted
+  without fee, provided that the above copyright notice appear in 
+  all copies and that both that the copyright notice and this
+  permission notice and warranty disclaimer appear in supporting 
+  documentation, and that the name of the author not be used in 
+  advertising or publicity pertaining to distribution of the 
+  software without specific, written prior permission.
+
+  The author disclaim all warranties with regard to this
+  software, including all implied warranties of merchantability
+  and fitness.  In no event shall the author be liable for any
+  special, indirect or consequential damages or any damages
+  whatsoever resulting from loss of use, data or profits, whether
+  in an action of contract, negligence or other tortious action,
+  arising out of or in connection with the use or performance of
+  this software.
+*/
+
+/** \file
+ *
+ *  ISP Protocol handler, to process V2 Protocol wrapped ISP commands used in Atmel programmer devices.
+ */
+
+#include "ISPProtocol.h"
+
+#if defined(ENABLE_ISP_PROTOCOL) || defined(__DOXYGEN__)
+
+/** Handler for the CMD_ENTER_PROGMODE_ISP command, which attempts to enter programming mode on
+ *  the attached device, returning success or failure back to the host.
+ */
+void ISPProtocol_EnterISPMode(void)
+{
+	struct
+	{
+		uint8_t TimeoutMS;
+		uint8_t PinStabDelayMS;
+		uint8_t ExecutionDelayMS;
+		uint8_t SynchLoops;
+		uint8_t ByteDelay;
+		uint8_t PollValue;
+		uint8_t PollIndex;
+		uint8_t EnterProgBytes[4];
+	} Enter_ISP_Params;
+	
+	Endpoint_Read_Stream_LE(&Enter_ISP_Params, sizeof(Enter_ISP_Params), NO_STREAM_CALLBACK);
+
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+
+	uint8_t ResponseStatus = STATUS_CMD_FAILED;
+	
+	CurrentAddress = 0;
+	
+	/* Set up the synchronous USART to generate the recovery clock on XCK pin */
+	UBRR1  = (F_CPU / 500000UL);
+	UCSR1B = (1 << TXEN1);
+	UCSR1C = (1 << UMSEL10) | (1 << UPM11) | (1 << USBS1) | (1 << UCSZ11) | (1 << UCSZ10) | (1 << UCPOL1);
+	DDRD  |= (1 << 5);
+
+	/* Perform execution delay, initialize SPI bus */
+	ISPProtocol_DelayMS(Enter_ISP_Params.ExecutionDelayMS); 
+	SPI_Init(ISPTarget_GetSPIPrescalerMask() | SPI_SCK_LEAD_RISING | SPI_SAMPLE_LEADING | SPI_MODE_MASTER);
+
+	/* Continuously attempt to synchronize with the target until either the number of attempts specified
+	 * by the host has exceeded, or the the device sends back the expected response values */
+	while (Enter_ISP_Params.SynchLoops-- && (ResponseStatus == STATUS_CMD_FAILED) && TimeoutMSRemaining)
+	{
+		uint8_t ResponseBytes[4];
+
+		ISPTarget_ChangeTargetResetLine(true);
+		ISPProtocol_DelayMS(Enter_ISP_Params.PinStabDelayMS);
+
+		for (uint8_t RByte = 0; RByte < sizeof(ResponseBytes); RByte++)
+		{
+			ISPProtocol_DelayMS(Enter_ISP_Params.ByteDelay);
+			ResponseBytes[RByte] = SPI_TransferByte(Enter_ISP_Params.EnterProgBytes[RByte]);
+		}
+		
+		/* Check if polling disabled, or if the polled value matches the expected value */
+		if (!(Enter_ISP_Params.PollIndex) || (ResponseBytes[Enter_ISP_Params.PollIndex - 1] == Enter_ISP_Params.PollValue))
+		{
+			ResponseStatus = STATUS_CMD_OK;
+		}
+		else
+		{
+			ISPTarget_ChangeTargetResetLine(false);
+			ISPProtocol_DelayMS(Enter_ISP_Params.PinStabDelayMS);
+		}
+	}
+
+	Endpoint_Write_Byte(CMD_ENTER_PROGMODE_ISP);
+	Endpoint_Write_Byte(ResponseStatus);
+	Endpoint_ClearIN();
+}
+
+/** Handler for the CMD_LEAVE_ISP command, which releases the target from programming mode. */
+void ISPProtocol_LeaveISPMode(void)
+{
+	struct
+	{
+		uint8_t PreDelayMS;
+		uint8_t PostDelayMS;
+	} Leave_ISP_Params;
+
+	Endpoint_Read_Stream_LE(&Leave_ISP_Params, sizeof(Leave_ISP_Params), NO_STREAM_CALLBACK);
+	
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+
+	/* Perform pre-exit delay, release the target /RESET, disable the SPI bus and perform the post-exit delay */
+	ISPProtocol_DelayMS(Leave_ISP_Params.PreDelayMS);
+	ISPTarget_ChangeTargetResetLine(false);
+	SPI_ShutDown();
+	ISPProtocol_DelayMS(Leave_ISP_Params.PostDelayMS);
+
+	/* Turn off the synchronous USART to terminate the recovery clock on XCK pin */
+	UBRR1  = (F_CPU / 500000UL);
+	UCSR1B = (1 << TXEN1);
+	UCSR1C = (1 << UMSEL10) | (1 << UPM11) | (1 << USBS1) | (1 << UCSZ11) | (1 << UCSZ10) | (1 << UCPOL1);
+	DDRD  &= ~(1 << 5);
+
+	Endpoint_Write_Byte(CMD_LEAVE_PROGMODE_ISP);
+	Endpoint_Write_Byte(STATUS_CMD_OK);
+	Endpoint_ClearIN();
+}
+
+/** Handler for the CMD_PROGRAM_FLASH_ISP and CMD_PROGRAM_EEPROM_ISP commands, writing out bytes,
+ *  words or pages of data to the attached device.
+ *
+ *  \param[in] V2Command  Issued V2 Protocol command byte from the host
+ */
+void ISPProtocol_ProgramMemory(uint8_t V2Command)
+{
+	struct
+	{
+		uint16_t BytesToWrite;
+		uint8_t  ProgrammingMode;
+		uint8_t  DelayMS;
+		uint8_t  ProgrammingCommands[3];
+		uint8_t  PollValue1;
+		uint8_t  PollValue2;
+		uint8_t  ProgData[256]; // Note, the Jungo driver has a very short ACK timeout period, need to buffer the
+	} Write_Memory_Params;      // whole page and ACK the packet as fast as possible to prevent it from aborting
+	
+	Endpoint_Read_Stream_LE(&Write_Memory_Params, (sizeof(Write_Memory_Params) -
+	                                               sizeof(Write_Memory_Params.ProgData)), NO_STREAM_CALLBACK);
+
+
+	Write_Memory_Params.BytesToWrite = SwapEndian_16(Write_Memory_Params.BytesToWrite);
+	
+	if (Write_Memory_Params.BytesToWrite > sizeof(Write_Memory_Params.ProgData))
+	{
+		Endpoint_ClearOUT();
+		Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+		Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+
+		Endpoint_Write_Byte(V2Command);
+		Endpoint_Write_Byte(STATUS_CMD_FAILED);
+		Endpoint_ClearIN();
+		return;
+	}
+	
+	Endpoint_Read_Stream_LE(&Write_Memory_Params.ProgData, Write_Memory_Params.BytesToWrite, NO_STREAM_CALLBACK);
+
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+
+	uint8_t  ProgrammingStatus = STATUS_CMD_OK;	
+	uint16_t PollAddress       = 0;
+	uint8_t  PollValue         = (V2Command == CMD_PROGRAM_FLASH_ISP) ? Write_Memory_Params.PollValue1 :
+	                                                                    Write_Memory_Params.PollValue2;
+	uint8_t* NextWriteByte = Write_Memory_Params.ProgData;
+
+	/* Check to see if the host has issued a SET ADDRESS command and we haven't sent a
+	 * LOAD EXTENDED ADDRESS command (if needed, used when operating beyond the 128KB
+	 * FLASH barrier) */
+	if (MustSetAddress)
+	{
+		if (CurrentAddress & (1UL << 31))
+		  ISPTarget_LoadExtendedAddress();
+
+		MustSetAddress = false;
+	}
+
+	/* Check the programming mode desired by the host, either Paged or Word memory writes */
+	if (Write_Memory_Params.ProgrammingMode & PROG_MODE_PAGED_WRITES_MASK)
+	{
+		uint16_t StartAddress = (CurrentAddress & 0xFFFF);
+	
+		/* Paged mode memory programming */
+		for (uint16_t CurrentByte = 0; CurrentByte < Write_Memory_Params.BytesToWrite; CurrentByte++)
+		{
+			bool    IsOddByte   = (CurrentByte & 0x01);
+			uint8_t ByteToWrite = *(NextWriteByte++);
+		
+			SPI_SendByte(Write_Memory_Params.ProgrammingCommands[0]);
+			SPI_SendByte(CurrentAddress >> 8);
+			SPI_SendByte(CurrentAddress & 0xFF);
+			SPI_SendByte(ByteToWrite);
+			
+			/* AVR FLASH addressing requires us to modify the write command based on if we are writing a high
+			 * or low byte at the current word address */
+			if (V2Command == CMD_PROGRAM_FLASH_ISP)
+			  Write_Memory_Params.ProgrammingCommands[0] ^= READ_WRITE_HIGH_BYTE_MASK;
+
+			/* Check to see the write completion method, to see if we have a valid polling address */
+			if (!(PollAddress) && (ByteToWrite != PollValue))
+			{
+				if (IsOddByte && (V2Command == CMD_PROGRAM_FLASH_ISP))
+				  Write_Memory_Params.ProgrammingCommands[2] |= READ_WRITE_HIGH_BYTE_MASK;
+
+				PollAddress = (CurrentAddress & 0xFFFF);				
+			}		
+
+			if (IsOddByte || (V2Command == CMD_PROGRAM_EEPROM_ISP))
+			  CurrentAddress++;
+		}
+		
+		/* If the current page must be committed, send the PROGRAM PAGE command to the target */
+		if (Write_Memory_Params.ProgrammingMode & PROG_MODE_COMMIT_PAGE_MASK)
+		{
+			SPI_SendByte(Write_Memory_Params.ProgrammingCommands[1]);
+			SPI_SendByte(StartAddress >> 8);
+			SPI_SendByte(StartAddress & 0xFF);
+			SPI_SendByte(0x00);
+			
+			/* Check if polling is possible, if not switch to timed delay mode */
+			if (!(PollAddress))
+			{
+				Write_Memory_Params.ProgrammingMode &= ~PROG_MODE_PAGED_VALUE_MASK;
+				Write_Memory_Params.ProgrammingMode |=  PROG_MODE_PAGED_TIMEDELAY_MASK;				
+			}
+
+			ProgrammingStatus = ISPTarget_WaitForProgComplete(Write_Memory_Params.ProgrammingMode, PollAddress, PollValue,
+			                                                  Write_Memory_Params.DelayMS, Write_Memory_Params.ProgrammingCommands[2]);
+		}
+	}
+	else
+	{
+		/* Word/byte mode memory programming */
+		for (uint16_t CurrentByte = 0; CurrentByte < Write_Memory_Params.BytesToWrite; CurrentByte++)
+		{
+			bool    IsOddByte   = (CurrentByte & 0x01);
+			uint8_t ByteToWrite = *(NextWriteByte++);
+			  
+			SPI_SendByte(Write_Memory_Params.ProgrammingCommands[0]);
+			SPI_SendByte(CurrentAddress >> 8);
+			SPI_SendByte(CurrentAddress & 0xFF);
+			SPI_SendByte(ByteToWrite);
+			
+			/* AVR FLASH addressing requires us to modify the write command based on if we are writing a high
+			 * or low byte at the current word address */
+			if (V2Command == CMD_PROGRAM_FLASH_ISP)
+			  Write_Memory_Params.ProgrammingCommands[0] ^= READ_WRITE_HIGH_BYTE_MASK;
+
+			if (ByteToWrite != PollValue)
+			{
+				if (IsOddByte && (V2Command == CMD_PROGRAM_FLASH_ISP))
+				  Write_Memory_Params.ProgrammingCommands[2] |= READ_WRITE_HIGH_BYTE_MASK;
+				  
+				PollAddress = (CurrentAddress & 0xFFFF);
+			}
+
+			if (IsOddByte || (V2Command == CMD_PROGRAM_EEPROM_ISP))
+			  CurrentAddress++;
+			
+			ProgrammingStatus = ISPTarget_WaitForProgComplete(Write_Memory_Params.ProgrammingMode, PollAddress, PollValue,
+			                                                  Write_Memory_Params.DelayMS, Write_Memory_Params.ProgrammingCommands[2]);
+			  
+			if (ProgrammingStatus != STATUS_CMD_OK)
+			  break;
+		}
+	}
+
+	Endpoint_Write_Byte(V2Command);
+	Endpoint_Write_Byte(ProgrammingStatus);
+	Endpoint_ClearIN();
+}
+
+/** Handler for the CMD_READ_FLASH_ISP and CMD_READ_EEPROM_ISP commands, reading in bytes,
+ *  words or pages of data from the attached device.
+ *
+ *  \param[in] V2Command  Issued V2 Protocol command byte from the host
+ */
+void ISPProtocol_ReadMemory(uint8_t V2Command)
+{
+	struct
+	{
+		uint16_t BytesToRead;
+		uint8_t  ReadMemoryCommand;
+	} Read_Memory_Params;
+	
+	Endpoint_Read_Stream_LE(&Read_Memory_Params, sizeof(Read_Memory_Params), NO_STREAM_CALLBACK);
+	Read_Memory_Params.BytesToRead = SwapEndian_16(Read_Memory_Params.BytesToRead);
+	
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+	
+	Endpoint_Write_Byte(V2Command);
+	Endpoint_Write_Byte(STATUS_CMD_OK);
+	
+	/* Check to see if the host has issued a SET ADDRESS command and we haven't sent a
+	 * LOAD EXTENDED ADDRESS command (if needed, used when operating beyond the 128KB
+	 * FLASH barrier) */
+	if (MustSetAddress)
+	{
+		if (CurrentAddress & (1UL << 31))
+		  ISPTarget_LoadExtendedAddress();
+
+		MustSetAddress = false;
+	}
+
+	/* Read each byte from the device and write them to the packet for the host */
+	for (uint16_t CurrentByte = 0; CurrentByte < Read_Memory_Params.BytesToRead; CurrentByte++)
+	{
+		/* Read the next byte from the desired memory space in the device */
+		SPI_SendByte(Read_Memory_Params.ReadMemoryCommand);
+		SPI_SendByte(CurrentAddress >> 8);
+		SPI_SendByte(CurrentAddress & 0xFF);
+		Endpoint_Write_Byte(SPI_ReceiveByte());
+		
+		/* Check if the endpoint bank is currently full, if so send the packet */
+		if (!(Endpoint_IsReadWriteAllowed()))
+		{
+			Endpoint_ClearIN();
+			Endpoint_WaitUntilReady();
+		}
+		
+		/* AVR FLASH addressing requires us to modify the read command based on if we are reading a high
+		 * or low byte at the current word address */
+		if (V2Command == CMD_READ_FLASH_ISP)
+		  Read_Memory_Params.ReadMemoryCommand ^= READ_WRITE_HIGH_BYTE_MASK;
+
+		/* Only increment the current address if we have read both bytes in the current word when in FLASH
+		 * read mode, or for each byte when in EEPROM read mode */		 
+		if (((CurrentByte & 0x01) && (V2Command == CMD_READ_FLASH_ISP)) || (V2Command == CMD_READ_EEPROM_ISP))
+		  CurrentAddress++;
+	}
+
+	Endpoint_Write_Byte(STATUS_CMD_OK);
+
+	bool IsEndpointFull = !(Endpoint_IsReadWriteAllowed());
+	Endpoint_ClearIN();
+	
+	/* Ensure last packet is a short packet to terminate the transfer */
+	if (IsEndpointFull)
+	{
+		Endpoint_WaitUntilReady();	
+		Endpoint_ClearIN();
+		Endpoint_WaitUntilReady();	
+	}
+}
+
+/** Handler for the CMD_CHI_ERASE_ISP command, clearing the target's FLASH memory. */
+void ISPProtocol_ChipErase(void)
+{
+	struct
+	{
+		uint8_t EraseDelayMS;
+		uint8_t PollMethod;
+		uint8_t EraseCommandBytes[4];
+	} Erase_Chip_Params;
+	
+	Endpoint_Read_Stream_LE(&Erase_Chip_Params, sizeof(Erase_Chip_Params), NO_STREAM_CALLBACK);
+	
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+	
+	uint8_t ResponseStatus = STATUS_CMD_OK;
+	
+	/* Send the chip erase commands as given by the host to the device */
+	for (uint8_t SByte = 0; SByte < sizeof(Erase_Chip_Params.EraseCommandBytes); SByte++)
+	  SPI_SendByte(Erase_Chip_Params.EraseCommandBytes[SByte]);
+
+	/* Use appropriate command completion check as given by the host (delay or busy polling) */
+	if (!(Erase_Chip_Params.PollMethod))
+	  ISPProtocol_DelayMS(Erase_Chip_Params.EraseDelayMS);
+	else
+	  ResponseStatus = ISPTarget_WaitWhileTargetBusy();
+	  
+	Endpoint_Write_Byte(CMD_CHIP_ERASE_ISP);
+	Endpoint_Write_Byte(ResponseStatus);
+	Endpoint_ClearIN();
+}
+
+/** Handler for the CMD_READ_FUSE_ISP, CMD_READ_LOCK_ISP, CMD_READ_SIGNATURE_ISP and CMD_READ_OSCCAL commands,
+ *  reading the requested configuration byte from the device.
+ *
+ *  \param[in] V2Command  Issued V2 Protocol command byte from the host
+ */
+void ISPProtocol_ReadFuseLockSigOSCCAL(uint8_t V2Command)
+{
+	struct
+	{
+		uint8_t RetByte;
+		uint8_t ReadCommandBytes[4];
+	} Read_FuseLockSigOSCCAL_Params;
+	
+	Endpoint_Read_Stream_LE(&Read_FuseLockSigOSCCAL_Params, sizeof(Read_FuseLockSigOSCCAL_Params), NO_STREAM_CALLBACK);
+
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+
+	uint8_t ResponseBytes[4];
+
+	/* Send the Fuse or Lock byte read commands as given by the host to the device, store response */
+	for (uint8_t RByte = 0; RByte < sizeof(ResponseBytes); RByte++)
+	  ResponseBytes[RByte] = SPI_TransferByte(Read_FuseLockSigOSCCAL_Params.ReadCommandBytes[RByte]);
+		
+	Endpoint_Write_Byte(V2Command);
+	Endpoint_Write_Byte(STATUS_CMD_OK);
+	Endpoint_Write_Byte(ResponseBytes[Read_FuseLockSigOSCCAL_Params.RetByte - 1]);
+	Endpoint_Write_Byte(STATUS_CMD_OK);
+	Endpoint_ClearIN();
+}
+
+/** Handler for the CMD_WRITE_FUSE_ISP and CMD_WRITE_LOCK_ISP commands, writing the requested configuration
+ *  byte to the device.
+ *
+ *  \param[in] V2Command  Issued V2 Protocol command byte from the host
+ */
+void ISPProtocol_WriteFuseLock(uint8_t V2Command)
+{
+	struct
+	{
+		uint8_t WriteCommandBytes[4];
+	} Write_FuseLockSig_Params;
+	
+	Endpoint_Read_Stream_LE(&Write_FuseLockSig_Params, sizeof(Write_FuseLockSig_Params), NO_STREAM_CALLBACK);
+
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+
+	/* Send the Fuse or Lock byte program commands as given by the host to the device */
+	for (uint8_t SByte = 0; SByte < sizeof(Write_FuseLockSig_Params.WriteCommandBytes); SByte++)
+	  SPI_SendByte(Write_FuseLockSig_Params.WriteCommandBytes[SByte]);
+		
+	Endpoint_Write_Byte(V2Command);
+	Endpoint_Write_Byte(STATUS_CMD_OK);
+	Endpoint_Write_Byte(STATUS_CMD_OK);
+	Endpoint_ClearIN();
+}
+
+/** Handler for the CMD_SPI_MULTI command, writing and reading arbitrary SPI data to and from the attached device. */
+void ISPProtocol_SPIMulti(void)
+{
+	struct
+	{
+		uint8_t TxBytes;
+		uint8_t RxBytes;
+		uint8_t RxStartAddr;
+		uint8_t TxData[255];
+	} SPI_Multi_Params;
+	
+	Endpoint_Read_Stream_LE(&SPI_Multi_Params, (sizeof(SPI_Multi_Params) - sizeof(SPI_Multi_Params.TxData)), NO_STREAM_CALLBACK);
+	Endpoint_Read_Stream_LE(&SPI_Multi_Params.TxData, SPI_Multi_Params.TxBytes, NO_STREAM_CALLBACK);
+	
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+	
+	Endpoint_Write_Byte(CMD_SPI_MULTI);
+	Endpoint_Write_Byte(STATUS_CMD_OK);
+
+	uint8_t CurrTxPos = 0;
+	uint8_t CurrRxPos = 0;
+
+	/* Write out bytes to transmit until the start of the bytes to receive is met */
+	while (CurrTxPos < SPI_Multi_Params.RxStartAddr)
+	{
+		if (CurrTxPos < SPI_Multi_Params.TxBytes)
+		  SPI_SendByte(SPI_Multi_Params.TxData[CurrTxPos]);
+		else
+		  SPI_SendByte(0);
+		
+		CurrTxPos++;
+	}
+
+	/* Transmit remaining bytes with padding as needed, read in response bytes */
+	while (CurrRxPos < SPI_Multi_Params.RxBytes)
+	{
+		if (CurrTxPos < SPI_Multi_Params.TxBytes)
+		  Endpoint_Write_Byte(SPI_TransferByte(SPI_Multi_Params.TxData[CurrTxPos++]));
+		else
+		  Endpoint_Write_Byte(SPI_ReceiveByte());
+		  
+		/* Check to see if we have filled the endpoint bank and need to send the packet */
+		if (!(Endpoint_IsReadWriteAllowed()))
+		{
+			Endpoint_ClearIN();
+			Endpoint_WaitUntilReady();
+		}
+		
+		CurrRxPos++;
+	}	
+	
+	Endpoint_Write_Byte(STATUS_CMD_OK);
+
+	bool IsEndpointFull = !(Endpoint_IsReadWriteAllowed());
+	Endpoint_ClearIN();
+	
+	/* Ensure last packet is a short packet to terminate the transfer */
+	if (IsEndpointFull)
+	{
+		Endpoint_WaitUntilReady();	
+		Endpoint_ClearIN();
+		Endpoint_WaitUntilReady();	
+	}
+}
+
+/** Blocking delay for a given number of milliseconds.
+ *
+ *  \param[in] DelayMS  Number of milliseconds to delay for
+ */
+void ISPProtocol_DelayMS(uint8_t DelayMS)
+{
+	while (DelayMS-- && TimeoutMSRemaining)
+	{
+		if (TimeoutMSRemaining)
+		  TimeoutMSRemaining--;
+		  
+		_delay_ms(1);
+	}
+}
+
 #endif
\ No newline at end of file
diff --git a/Projects/AVRISP-MKII/Lib/ISP/ISPProtocol.h b/Projects/AVRISP-MKII/Lib/ISP/ISPProtocol.h
index a9114e1e8..c983f49c6 100644
--- a/Projects/AVRISP-MKII/Lib/ISP/ISPProtocol.h
+++ b/Projects/AVRISP-MKII/Lib/ISP/ISPProtocol.h
@@ -1,79 +1,79 @@
-/*

-             LUFA Library

-     Copyright (C) Dean Camera, 2010.

-              

-  dean [at] fourwalledcubicle [dot] com

-      www.fourwalledcubicle.com

-*/

-

-/*

-  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)

-

-  Permission to use, copy, modify, distribute, and sell this 

-  software and its documentation for any purpose is hereby granted

-  without fee, provided that the above copyright notice appear in 

-  all copies and that both that the copyright notice and this

-  permission notice and warranty disclaimer appear in supporting 

-  documentation, and that the name of the author not be used in 

-  advertising or publicity pertaining to distribution of the 

-  software without specific, written prior permission.

-

-  The author disclaim all warranties with regard to this

-  software, including all implied warranties of merchantability

-  and fitness.  In no event shall the author be liable for any

-  special, indirect or consequential damages or any damages

-  whatsoever resulting from loss of use, data or profits, whether

-  in an action of contract, negligence or other tortious action,

-  arising out of or in connection with the use or performance of

-  this software.

-*/

-

-/** \file

- *

- *  Header file for ISPProtocol.c.

- */

-

-#ifndef _ISP_PROTOCOL_

-#define _ISP_PROTOCOL_

-

-	/* Includes: */

-		#include <avr/io.h>

-		#include <util/delay.h>

-		

-		#include <LUFA/Drivers/USB/USB.h>

-

-		#include "../V2Protocol.h"

-		

-	/* Preprocessor Checks: */

-		#if ((BOARD == BOARD_XPLAIN) || (BOARD == BOARD_XPLAIN_REV1))

-			#undef ENABLE_ISP_PROTOCOL

-			

-			#if !defined(ENABLE_XPROG_PROTOCOL)

-				#define ENABLE_XPROG_PROTOCOL

-			#endif

-		#endif

-

-	/* Macros: */

-		/** Mask for the reading or writing of the high byte in a FLASH word when issuing a low-level programming command */

-		#define READ_WRITE_HIGH_BYTE_MASK       (1 << 3)

-

-		#define PROG_MODE_PAGED_WRITES_MASK     (1 << 0)

-		#define PROG_MODE_WORD_TIMEDELAY_MASK   (1 << 1)

-		#define PROG_MODE_WORD_VALUE_MASK       (1 << 2)

-		#define PROG_MODE_WORD_READYBUSY_MASK   (1 << 3)

-		#define PROG_MODE_PAGED_TIMEDELAY_MASK  (1 << 4)

-		#define PROG_MODE_PAGED_VALUE_MASK      (1 << 5)

-		#define PROG_MODE_PAGED_READYBUSY_MASK  (1 << 6)

-		#define PROG_MODE_COMMIT_PAGE_MASK      (1 << 7)

-

-	/* Function Prototypes: */

-		void ISPProtocol_EnterISPMode(void);

-		void ISPProtocol_LeaveISPMode(void);

-		void ISPProtocol_ProgramMemory(const uint8_t V2Command);

-		void ISPProtocol_ReadMemory(const uint8_t V2Command);

-		void ISPProtocol_ChipErase(void);

-		void ISPProtocol_ReadFuseLockSigOSCCAL(const uint8_t V2Command);

-		void ISPProtocol_WriteFuseLock(const uint8_t V2Command);

-		void ISPProtocol_SPIMulti(void);

-		void ISPProtocol_DelayMS(uint8_t DelayMS);

-#endif

+/*
+             LUFA Library
+     Copyright (C) Dean Camera, 2010.
+              
+  dean [at] fourwalledcubicle [dot] com
+      www.fourwalledcubicle.com
+*/
+
+/*
+  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)
+
+  Permission to use, copy, modify, distribute, and sell this 
+  software and its documentation for any purpose is hereby granted
+  without fee, provided that the above copyright notice appear in 
+  all copies and that both that the copyright notice and this
+  permission notice and warranty disclaimer appear in supporting 
+  documentation, and that the name of the author not be used in 
+  advertising or publicity pertaining to distribution of the 
+  software without specific, written prior permission.
+
+  The author disclaim all warranties with regard to this
+  software, including all implied warranties of merchantability
+  and fitness.  In no event shall the author be liable for any
+  special, indirect or consequential damages or any damages
+  whatsoever resulting from loss of use, data or profits, whether
+  in an action of contract, negligence or other tortious action,
+  arising out of or in connection with the use or performance of
+  this software.
+*/
+
+/** \file
+ *
+ *  Header file for ISPProtocol.c.
+ */
+
+#ifndef _ISP_PROTOCOL_
+#define _ISP_PROTOCOL_
+
+	/* Includes: */
+		#include <avr/io.h>
+		#include <util/delay.h>
+		
+		#include <LUFA/Drivers/USB/USB.h>
+
+		#include "../V2Protocol.h"
+		
+	/* Preprocessor Checks: */
+		#if ((BOARD == BOARD_XPLAIN) || (BOARD == BOARD_XPLAIN_REV1))
+			#undef ENABLE_ISP_PROTOCOL
+			
+			#if !defined(ENABLE_XPROG_PROTOCOL)
+				#define ENABLE_XPROG_PROTOCOL
+			#endif
+		#endif
+
+	/* Macros: */
+		/** Mask for the reading or writing of the high byte in a FLASH word when issuing a low-level programming command */
+		#define READ_WRITE_HIGH_BYTE_MASK       (1 << 3)
+
+		#define PROG_MODE_PAGED_WRITES_MASK     (1 << 0)
+		#define PROG_MODE_WORD_TIMEDELAY_MASK   (1 << 1)
+		#define PROG_MODE_WORD_VALUE_MASK       (1 << 2)
+		#define PROG_MODE_WORD_READYBUSY_MASK   (1 << 3)
+		#define PROG_MODE_PAGED_TIMEDELAY_MASK  (1 << 4)
+		#define PROG_MODE_PAGED_VALUE_MASK      (1 << 5)
+		#define PROG_MODE_PAGED_READYBUSY_MASK  (1 << 6)
+		#define PROG_MODE_COMMIT_PAGE_MASK      (1 << 7)
+
+	/* Function Prototypes: */
+		void ISPProtocol_EnterISPMode(void);
+		void ISPProtocol_LeaveISPMode(void);
+		void ISPProtocol_ProgramMemory(const uint8_t V2Command);
+		void ISPProtocol_ReadMemory(const uint8_t V2Command);
+		void ISPProtocol_ChipErase(void);
+		void ISPProtocol_ReadFuseLockSigOSCCAL(const uint8_t V2Command);
+		void ISPProtocol_WriteFuseLock(const uint8_t V2Command);
+		void ISPProtocol_SPIMulti(void);
+		void ISPProtocol_DelayMS(uint8_t DelayMS);
+#endif
diff --git a/Projects/AVRISP-MKII/Lib/ISP/ISPTarget.c b/Projects/AVRISP-MKII/Lib/ISP/ISPTarget.c
index 1c5376579..d7c6882cd 100644
--- a/Projects/AVRISP-MKII/Lib/ISP/ISPTarget.c
+++ b/Projects/AVRISP-MKII/Lib/ISP/ISPTarget.c
@@ -1,187 +1,187 @@
-/*

-             LUFA Library

-     Copyright (C) Dean Camera, 2010.

-              

-  dean [at] fourwalledcubicle [dot] com

-      www.fourwalledcubicle.com

-*/

-

-/*

-  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)

-

-  Permission to use, copy, modify, distribute, and sell this 

-  software and its documentation for any purpose is hereby granted

-  without fee, provided that the above copyright notice appear in 

-  all copies and that both that the copyright notice and this

-  permission notice and warranty disclaimer appear in supporting 

-  documentation, and that the name of the author not be used in 

-  advertising or publicity pertaining to distribution of the 

-  software without specific, written prior permission.

-

-  The author disclaim all warranties with regard to this

-  software, including all implied warranties of merchantability

-  and fitness.  In no event shall the author be liable for any

-  special, indirect or consequential damages or any damages

-  whatsoever resulting from loss of use, data or profits, whether

-  in an action of contract, negligence or other tortious action,

-  arising out of or in connection with the use or performance of

-  this software.

-*/

-

-/** \file

- *

- *  Target-related functions for the ISP Protocol decoder.

- */

-

-#include "ISPTarget.h"

-

-#if defined(ENABLE_ISP_PROTOCOL) || defined(__DOXYGEN__)

-

-/** Converts the given AVR Studio SCK duration parameter (set by a SET PARAM command from the host) to the nearest

- *  possible SPI clock prescaler mask for passing to the SPI_Init() routine.

- *

- *  \return Nearest SPI prescaler mask for the given SCK frequency

- */

-uint8_t ISPTarget_GetSPIPrescalerMask(void)

-{

-	static const uint8_t SPIMaskFromSCKDuration[] =

-	{

-	#if (F_CPU == 8000000)

-		SPI_SPEED_FCPU_DIV_2,    // AVRStudio =   8MHz SPI, Actual =   4MHz SPI

-		SPI_SPEED_FCPU_DIV_2,    // AVRStudio =   4MHz SPI, Actual =   4MHz SPI

-		SPI_SPEED_FCPU_DIV_4,    // AVRStudio =   2MHz SPI, Actual =   2MHz SPI

-		SPI_SPEED_FCPU_DIV_8,    // AVRStudio =   1MHz SPI, Actual =   1MHz SPI

-		SPI_SPEED_FCPU_DIV_16,   // AVRStudio = 500KHz SPI, Actual = 500KHz SPI

-		SPI_SPEED_FCPU_DIV_32,   // AVRStudio = 250KHz SPI, Actual = 250KHz SPI

-		SPI_SPEED_FCPU_DIV_64,   // AVRStudio = 125KHz SPI, Actual = 125KHz SPI

-	#elif (F_CPU == 16000000)

-		SPI_SPEED_FCPU_DIV_2,    // AVRStudio =   8MHz SPI, Actual =   8MHz SPI

-		SPI_SPEED_FCPU_DIV_4,    // AVRStudio =   4MHz SPI, Actual =   4MHz SPI

-		SPI_SPEED_FCPU_DIV_8,    // AVRStudio =   2MHz SPI, Actual =   2MHz SPI

-		SPI_SPEED_FCPU_DIV_16,   // AVRStudio =   1MHz SPI, Actual =   1MHz SPI

-		SPI_SPEED_FCPU_DIV_32,   // AVRStudio = 500KHz SPI, Actual = 500KHz SPI

-		SPI_SPEED_FCPU_DIV_64,   // AVRStudio = 250KHz SPI, Actual = 250KHz SPI

-		SPI_SPEED_FCPU_DIV_128   // AVRStudio = 125KHz SPI, Actual = 125KHz SPI

-	#else

-		#error No SPI prescaler masks for chosen F_CPU speed.

-	#endif

-	};

-

-	uint8_t SCKDuration = V2Params_GetParameterValue(PARAM_SCK_DURATION);

-

-	if (SCKDuration >= sizeof(SPIMaskFromSCKDuration))

-	  SCKDuration = (sizeof(SPIMaskFromSCKDuration) - 1);

-	  

-	return SPIMaskFromSCKDuration[SCKDuration];

-}

-

-/** Asserts or deasserts the target's reset line, using the correct polarity as set by the host using a SET PARAM command.

- *  When not asserted, the line is tristated so as not to interfere with normal device operation.

- *

- *  \param[in] ResetTarget Boolean true when the target should be held in reset, false otherwise

- */

-void ISPTarget_ChangeTargetResetLine(const bool ResetTarget)

-{

-	if (ResetTarget)

-	{

-		AUX_LINE_DDR |= AUX_LINE_MASK;

-		

-		if (!(V2Params_GetParameterValue(PARAM_RESET_POLARITY)))

-		  AUX_LINE_PORT |= AUX_LINE_MASK;

-	}

-	else

-	{

-		AUX_LINE_DDR  &= ~AUX_LINE_MASK;

-		AUX_LINE_PORT &= ~AUX_LINE_MASK;

-	}

-}

-

-/** Waits until the last issued target memory programming command has completed, via the check mode given and using

- *  the given parameters.

- *

- *  \param[in] ProgrammingMode  Programming mode used and completion check to use, a mask of PROG_MODE_* constants

- *  \param[in] PollAddress  Memory address to poll for completion if polling check mode used

- *  \param[in] PollValue  Poll value to check against if polling check mode used

- *  \param[in] DelayMS  Milliseconds to delay before returning if delay check mode used

- *  \param[in] ReadMemCommand  Device low-level READ MEMORY command to send if value check mode used

- *

- *  \return V2 Protocol status \ref STATUS_CMD_OK if the no timeout occurred, \ref STATUS_RDY_BSY_TOUT or

- *          \ref STATUS_CMD_TOUT otherwise

- */

-uint8_t ISPTarget_WaitForProgComplete(const uint8_t ProgrammingMode, const uint16_t PollAddress, const uint8_t PollValue,

-                                      const uint8_t DelayMS, const uint8_t ReadMemCommand)

-{

-	uint8_t ProgrammingStatus  = STATUS_CMD_OK;

-

-	/* Determine method of Programming Complete check */

-	switch (ProgrammingMode & ~(PROG_MODE_PAGED_WRITES_MASK | PROG_MODE_COMMIT_PAGE_MASK))

-	{

-		case PROG_MODE_WORD_TIMEDELAY_MASK:

-		case PROG_MODE_PAGED_TIMEDELAY_MASK:

-			ISPProtocol_DelayMS(DelayMS);

-			break;

-		case PROG_MODE_WORD_VALUE_MASK:

-		case PROG_MODE_PAGED_VALUE_MASK:

-			do

-			{

-				SPI_SendByte(ReadMemCommand);

-				SPI_SendByte(PollAddress >> 8);

-				SPI_SendByte(PollAddress & 0xFF);

-			}

-			while ((SPI_TransferByte(0x00) == PollValue) && TimeoutMSRemaining);

-

-			if (!(TimeoutMSRemaining))

-			 ProgrammingStatus = STATUS_CMD_TOUT;

-			

-			break;		

-		case PROG_MODE_WORD_READYBUSY_MASK:

-		case PROG_MODE_PAGED_READYBUSY_MASK:

-			ProgrammingStatus = ISPTarget_WaitWhileTargetBusy();

-			break;

-	}

-

-	if (ProgrammingStatus == STATUS_CMD_OK)

-	  TimeoutMSRemaining = COMMAND_TIMEOUT_MS;

-

-	return ProgrammingStatus;

-}

-

-/** Waits until the target has completed the last operation, by continuously polling the device's

- *  BUSY flag until it is cleared, or until the command timeout period has expired.

- *

- *  \return V2 Protocol status \ref STATUS_CMD_OK if the no timeout occurred, \ref STATUS_RDY_BSY_TOUT otherwise

- */

-uint8_t ISPTarget_WaitWhileTargetBusy(void)

-{

-	do

-	{

-		SPI_SendByte(0xF0);

-		SPI_SendByte(0x00);

-		SPI_SendByte(0x00);

-	}

-	while ((SPI_ReceiveByte() & 0x01) && TimeoutMSRemaining);

-

-	if (TimeoutMSRemaining)

-	{

-		TimeoutMSRemaining = COMMAND_TIMEOUT_MS;

-		return STATUS_CMD_OK;

-	}

-	else

-	{

-		return STATUS_RDY_BSY_TOUT;

-	}

-}

-

-/** Sends a low-level LOAD EXTENDED ADDRESS command to the target, for addressing of memory beyond the

- *  64KB boundary. This sends the command with the correct address as indicated by the current address

- *  pointer variable set by the host when a SET ADDRESS command is issued.

- */

-void ISPTarget_LoadExtendedAddress(void)

-{

-	SPI_SendByte(LOAD_EXTENDED_ADDRESS_CMD);

-	SPI_SendByte(0x00);

-	SPI_SendByte((CurrentAddress & 0x00FF0000) >> 16);

-	SPI_SendByte(0x00);	

-}

-

-#endif

+/*
+             LUFA Library
+     Copyright (C) Dean Camera, 2010.
+              
+  dean [at] fourwalledcubicle [dot] com
+      www.fourwalledcubicle.com
+*/
+
+/*
+  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)
+
+  Permission to use, copy, modify, distribute, and sell this 
+  software and its documentation for any purpose is hereby granted
+  without fee, provided that the above copyright notice appear in 
+  all copies and that both that the copyright notice and this
+  permission notice and warranty disclaimer appear in supporting 
+  documentation, and that the name of the author not be used in 
+  advertising or publicity pertaining to distribution of the 
+  software without specific, written prior permission.
+
+  The author disclaim all warranties with regard to this
+  software, including all implied warranties of merchantability
+  and fitness.  In no event shall the author be liable for any
+  special, indirect or consequential damages or any damages
+  whatsoever resulting from loss of use, data or profits, whether
+  in an action of contract, negligence or other tortious action,
+  arising out of or in connection with the use or performance of
+  this software.
+*/
+
+/** \file
+ *
+ *  Target-related functions for the ISP Protocol decoder.
+ */
+
+#include "ISPTarget.h"
+
+#if defined(ENABLE_ISP_PROTOCOL) || defined(__DOXYGEN__)
+
+/** Converts the given AVR Studio SCK duration parameter (set by a SET PARAM command from the host) to the nearest
+ *  possible SPI clock prescaler mask for passing to the SPI_Init() routine.
+ *
+ *  \return Nearest SPI prescaler mask for the given SCK frequency
+ */
+uint8_t ISPTarget_GetSPIPrescalerMask(void)
+{
+	static const uint8_t SPIMaskFromSCKDuration[] =
+	{
+	#if (F_CPU == 8000000)
+		SPI_SPEED_FCPU_DIV_2,    // AVRStudio =   8MHz SPI, Actual =   4MHz SPI
+		SPI_SPEED_FCPU_DIV_2,    // AVRStudio =   4MHz SPI, Actual =   4MHz SPI
+		SPI_SPEED_FCPU_DIV_4,    // AVRStudio =   2MHz SPI, Actual =   2MHz SPI
+		SPI_SPEED_FCPU_DIV_8,    // AVRStudio =   1MHz SPI, Actual =   1MHz SPI
+		SPI_SPEED_FCPU_DIV_16,   // AVRStudio = 500KHz SPI, Actual = 500KHz SPI
+		SPI_SPEED_FCPU_DIV_32,   // AVRStudio = 250KHz SPI, Actual = 250KHz SPI
+		SPI_SPEED_FCPU_DIV_64,   // AVRStudio = 125KHz SPI, Actual = 125KHz SPI
+	#elif (F_CPU == 16000000)
+		SPI_SPEED_FCPU_DIV_2,    // AVRStudio =   8MHz SPI, Actual =   8MHz SPI
+		SPI_SPEED_FCPU_DIV_4,    // AVRStudio =   4MHz SPI, Actual =   4MHz SPI
+		SPI_SPEED_FCPU_DIV_8,    // AVRStudio =   2MHz SPI, Actual =   2MHz SPI
+		SPI_SPEED_FCPU_DIV_16,   // AVRStudio =   1MHz SPI, Actual =   1MHz SPI
+		SPI_SPEED_FCPU_DIV_32,   // AVRStudio = 500KHz SPI, Actual = 500KHz SPI
+		SPI_SPEED_FCPU_DIV_64,   // AVRStudio = 250KHz SPI, Actual = 250KHz SPI
+		SPI_SPEED_FCPU_DIV_128   // AVRStudio = 125KHz SPI, Actual = 125KHz SPI
+	#else
+		#error No SPI prescaler masks for chosen F_CPU speed.
+	#endif
+	};
+
+	uint8_t SCKDuration = V2Params_GetParameterValue(PARAM_SCK_DURATION);
+
+	if (SCKDuration >= sizeof(SPIMaskFromSCKDuration))
+	  SCKDuration = (sizeof(SPIMaskFromSCKDuration) - 1);
+	  
+	return SPIMaskFromSCKDuration[SCKDuration];
+}
+
+/** Asserts or deasserts the target's reset line, using the correct polarity as set by the host using a SET PARAM command.
+ *  When not asserted, the line is tristated so as not to interfere with normal device operation.
+ *
+ *  \param[in] ResetTarget Boolean true when the target should be held in reset, false otherwise
+ */
+void ISPTarget_ChangeTargetResetLine(const bool ResetTarget)
+{
+	if (ResetTarget)
+	{
+		AUX_LINE_DDR |= AUX_LINE_MASK;
+		
+		if (!(V2Params_GetParameterValue(PARAM_RESET_POLARITY)))
+		  AUX_LINE_PORT |= AUX_LINE_MASK;
+	}
+	else
+	{
+		AUX_LINE_DDR  &= ~AUX_LINE_MASK;
+		AUX_LINE_PORT &= ~AUX_LINE_MASK;
+	}
+}
+
+/** Waits until the last issued target memory programming command has completed, via the check mode given and using
+ *  the given parameters.
+ *
+ *  \param[in] ProgrammingMode  Programming mode used and completion check to use, a mask of PROG_MODE_* constants
+ *  \param[in] PollAddress  Memory address to poll for completion if polling check mode used
+ *  \param[in] PollValue  Poll value to check against if polling check mode used
+ *  \param[in] DelayMS  Milliseconds to delay before returning if delay check mode used
+ *  \param[in] ReadMemCommand  Device low-level READ MEMORY command to send if value check mode used
+ *
+ *  \return V2 Protocol status \ref STATUS_CMD_OK if the no timeout occurred, \ref STATUS_RDY_BSY_TOUT or
+ *          \ref STATUS_CMD_TOUT otherwise
+ */
+uint8_t ISPTarget_WaitForProgComplete(const uint8_t ProgrammingMode, const uint16_t PollAddress, const uint8_t PollValue,
+                                      const uint8_t DelayMS, const uint8_t ReadMemCommand)
+{
+	uint8_t ProgrammingStatus  = STATUS_CMD_OK;
+
+	/* Determine method of Programming Complete check */
+	switch (ProgrammingMode & ~(PROG_MODE_PAGED_WRITES_MASK | PROG_MODE_COMMIT_PAGE_MASK))
+	{
+		case PROG_MODE_WORD_TIMEDELAY_MASK:
+		case PROG_MODE_PAGED_TIMEDELAY_MASK:
+			ISPProtocol_DelayMS(DelayMS);
+			break;
+		case PROG_MODE_WORD_VALUE_MASK:
+		case PROG_MODE_PAGED_VALUE_MASK:
+			do
+			{
+				SPI_SendByte(ReadMemCommand);
+				SPI_SendByte(PollAddress >> 8);
+				SPI_SendByte(PollAddress & 0xFF);
+			}
+			while ((SPI_TransferByte(0x00) == PollValue) && TimeoutMSRemaining);
+
+			if (!(TimeoutMSRemaining))
+			 ProgrammingStatus = STATUS_CMD_TOUT;
+			
+			break;		
+		case PROG_MODE_WORD_READYBUSY_MASK:
+		case PROG_MODE_PAGED_READYBUSY_MASK:
+			ProgrammingStatus = ISPTarget_WaitWhileTargetBusy();
+			break;
+	}
+
+	if (ProgrammingStatus == STATUS_CMD_OK)
+	  TimeoutMSRemaining = COMMAND_TIMEOUT_MS;
+
+	return ProgrammingStatus;
+}
+
+/** Waits until the target has completed the last operation, by continuously polling the device's
+ *  BUSY flag until it is cleared, or until the command timeout period has expired.
+ *
+ *  \return V2 Protocol status \ref STATUS_CMD_OK if the no timeout occurred, \ref STATUS_RDY_BSY_TOUT otherwise
+ */
+uint8_t ISPTarget_WaitWhileTargetBusy(void)
+{
+	do
+	{
+		SPI_SendByte(0xF0);
+		SPI_SendByte(0x00);
+		SPI_SendByte(0x00);
+	}
+	while ((SPI_ReceiveByte() & 0x01) && TimeoutMSRemaining);
+
+	if (TimeoutMSRemaining)
+	{
+		TimeoutMSRemaining = COMMAND_TIMEOUT_MS;
+		return STATUS_CMD_OK;
+	}
+	else
+	{
+		return STATUS_RDY_BSY_TOUT;
+	}
+}
+
+/** Sends a low-level LOAD EXTENDED ADDRESS command to the target, for addressing of memory beyond the
+ *  64KB boundary. This sends the command with the correct address as indicated by the current address
+ *  pointer variable set by the host when a SET ADDRESS command is issued.
+ */
+void ISPTarget_LoadExtendedAddress(void)
+{
+	SPI_SendByte(LOAD_EXTENDED_ADDRESS_CMD);
+	SPI_SendByte(0x00);
+	SPI_SendByte((CurrentAddress & 0x00FF0000) >> 16);
+	SPI_SendByte(0x00);	
+}
+
+#endif
diff --git a/Projects/AVRISP-MKII/Lib/ISP/ISPTarget.h b/Projects/AVRISP-MKII/Lib/ISP/ISPTarget.h
index 995461099..d6e943582 100644
--- a/Projects/AVRISP-MKII/Lib/ISP/ISPTarget.h
+++ b/Projects/AVRISP-MKII/Lib/ISP/ISPTarget.h
@@ -1,72 +1,72 @@
-/*

-             LUFA Library

-     Copyright (C) Dean Camera, 2010.

-              

-  dean [at] fourwalledcubicle [dot] com

-      www.fourwalledcubicle.com

-*/

-

-/*

-  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)

-

-  Permission to use, copy, modify, distribute, and sell this 

-  software and its documentation for any purpose is hereby granted

-  without fee, provided that the above copyright notice appear in 

-  all copies and that both that the copyright notice and this

-  permission notice and warranty disclaimer appear in supporting 

-  documentation, and that the name of the author not be used in 

-  advertising or publicity pertaining to distribution of the 

-  software without specific, written prior permission.

-

-  The author disclaim all warranties with regard to this

-  software, including all implied warranties of merchantability

-  and fitness.  In no event shall the author be liable for any

-  special, indirect or consequential damages or any damages

-  whatsoever resulting from loss of use, data or profits, whether

-  in an action of contract, negligence or other tortious action,

-  arising out of or in connection with the use or performance of

-  this software.

-*/

-

-/** \file

- *

- *  Header file for ISPTarget.c.

- */

-

-#ifndef _ISP_TARGET_

-#define _ISP_TARGET_

-

-	/* Includes: */

-		#include <avr/io.h>

-		#include <util/delay.h>

-

-		#include <LUFA/Drivers/USB/USB.h>

-		#include <LUFA/Drivers/Peripheral/SPI.h>

-		

-		#include "../V2ProtocolParams.h"

-

-	/* Preprocessor Checks: */

-		#if ((BOARD == BOARD_XPLAIN) || (BOARD == BOARD_XPLAIN_REV1))

-			#undef ENABLE_ISP_PROTOCOL

-			

-			#if !defined(ENABLE_XPROG_PROTOCOL)

-				#define ENABLE_XPROG_PROTOCOL

-			#endif

-		#endif

-

-	/* Macros: */

-		/** Total number of allowable ISP programming speeds supported by the device */

-		#define TOTAL_ISP_PROGRAMMING_SPEEDS  7

-		

-		#define LOAD_EXTENDED_ADDRESS_CMD     0x4D

-		

-	/* Function Prototypes: */

-		uint8_t ISPTarget_GetSPIPrescalerMask(void);

-		void    ISPTarget_ChangeTargetResetLine(const bool ResetTarget);

-		uint8_t ISPTarget_WaitForProgComplete(const uint8_t ProgrammingMode, const uint16_t PollAddress,

-		                                      const uint8_t PollValue, const uint8_t DelayMS,

-		                                      const uint8_t ReadMemCommand);

-		uint8_t ISPTarget_WaitWhileTargetBusy(void);

-		void    ISPTarget_LoadExtendedAddress(void);

-

-#endif

+/*
+             LUFA Library
+     Copyright (C) Dean Camera, 2010.
+              
+  dean [at] fourwalledcubicle [dot] com
+      www.fourwalledcubicle.com
+*/
+
+/*
+  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)
+
+  Permission to use, copy, modify, distribute, and sell this 
+  software and its documentation for any purpose is hereby granted
+  without fee, provided that the above copyright notice appear in 
+  all copies and that both that the copyright notice and this
+  permission notice and warranty disclaimer appear in supporting 
+  documentation, and that the name of the author not be used in 
+  advertising or publicity pertaining to distribution of the 
+  software without specific, written prior permission.
+
+  The author disclaim all warranties with regard to this
+  software, including all implied warranties of merchantability
+  and fitness.  In no event shall the author be liable for any
+  special, indirect or consequential damages or any damages
+  whatsoever resulting from loss of use, data or profits, whether
+  in an action of contract, negligence or other tortious action,
+  arising out of or in connection with the use or performance of
+  this software.
+*/
+
+/** \file
+ *
+ *  Header file for ISPTarget.c.
+ */
+
+#ifndef _ISP_TARGET_
+#define _ISP_TARGET_
+
+	/* Includes: */
+		#include <avr/io.h>
+		#include <util/delay.h>
+
+		#include <LUFA/Drivers/USB/USB.h>
+		#include <LUFA/Drivers/Peripheral/SPI.h>
+		
+		#include "../V2ProtocolParams.h"
+
+	/* Preprocessor Checks: */
+		#if ((BOARD == BOARD_XPLAIN) || (BOARD == BOARD_XPLAIN_REV1))
+			#undef ENABLE_ISP_PROTOCOL
+			
+			#if !defined(ENABLE_XPROG_PROTOCOL)
+				#define ENABLE_XPROG_PROTOCOL
+			#endif
+		#endif
+
+	/* Macros: */
+		/** Total number of allowable ISP programming speeds supported by the device */
+		#define TOTAL_ISP_PROGRAMMING_SPEEDS  7
+		
+		#define LOAD_EXTENDED_ADDRESS_CMD     0x4D
+		
+	/* Function Prototypes: */
+		uint8_t ISPTarget_GetSPIPrescalerMask(void);
+		void    ISPTarget_ChangeTargetResetLine(const bool ResetTarget);
+		uint8_t ISPTarget_WaitForProgComplete(const uint8_t ProgrammingMode, const uint16_t PollAddress,
+		                                      const uint8_t PollValue, const uint8_t DelayMS,
+		                                      const uint8_t ReadMemCommand);
+		uint8_t ISPTarget_WaitWhileTargetBusy(void);
+		void    ISPTarget_LoadExtendedAddress(void);
+
+#endif
diff --git a/Projects/AVRISP-MKII/Lib/V2Protocol.c b/Projects/AVRISP-MKII/Lib/V2Protocol.c
index 096551d81..3e12bdc11 100644
--- a/Projects/AVRISP-MKII/Lib/V2Protocol.c
+++ b/Projects/AVRISP-MKII/Lib/V2Protocol.c
@@ -1,259 +1,259 @@
-/*

-             LUFA Library

-     Copyright (C) Dean Camera, 2010.

-              

-  dean [at] fourwalledcubicle [dot] com

-      www.fourwalledcubicle.com

-*/

-

-/*

-  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)

-

-  Permission to use, copy, modify, distribute, and sell this 

-  software and its documentation for any purpose is hereby granted

-  without fee, provided that the above copyright notice appear in 

-  all copies and that both that the copyright notice and this

-  permission notice and warranty disclaimer appear in supporting 

-  documentation, and that the name of the author not be used in 

-  advertising or publicity pertaining to distribution of the 

-  software without specific, written prior permission.

-

-  The author disclaim all warranties with regard to this

-  software, including all implied warranties of merchantability

-  and fitness.  In no event shall the author be liable for any

-  special, indirect or consequential damages or any damages

-  whatsoever resulting from loss of use, data or profits, whether

-  in an action of contract, negligence or other tortious action,

-  arising out of or in connection with the use or performance of

-  this software.

-*/

-

-/** \file

- *

- *  V2Protocol handler, to process V2 Protocol commands used in Atmel programmer devices.

- */

-

-#define  INCLUDE_FROM_V2PROTOCOL_C

-#include "V2Protocol.h"

-

-/** Current memory address for FLASH/EEPROM memory read/write commands */

-uint32_t CurrentAddress;

-

-/** Flag to indicate that the next read/write operation must update the device's current address */

-bool MustSetAddress;

-

-

-/** ISR to manage timeouts whilst processing a V2Protocol command */

-ISR(TIMER0_COMPA_vect, ISR_NOBLOCK)

-{

-	if (TimeoutMSRemaining)

-	  TimeoutMSRemaining--;

-}

-

-/** Initializes the hardware and software associated with the V2 protocol command handling. */

-void V2Protocol_Init(void)

-{

-	#if defined(ADC)

-	/* Initialize the ADC converter for VTARGET level detection on supported AVR models */

-	ADC_Init(ADC_FREE_RUNNING | ADC_PRESCALE_128);

-	ADC_SetupChannel(VTARGET_ADC_CHANNEL);

-	ADC_StartReading(VTARGET_ADC_CHANNEL_MASK | ADC_RIGHT_ADJUSTED | ADC_REFERENCE_AVCC);

-	#endif

-	

-	/* Millisecond timer initialization for managing the command timeout counter */

-	OCR0A  = ((F_CPU / 64) / 1000);

-	TCCR0A = (1 << WGM01);

-	TIMSK0 = (1 << OCIE0A);

-	

-	V2Params_LoadNonVolatileParamValues();

-}

-

-/** Master V2 Protocol packet handler, for received V2 Protocol packets from a connected host.

- *  This routine decodes the issued command and passes off the handling of the command to the

- *  appropriate function.

- */

-void V2Protocol_ProcessCommand(void)

-{

-	uint8_t V2Command = Endpoint_Read_Byte();

-	

-	/* Start the timeout management timer */

-	TimeoutMSRemaining = COMMAND_TIMEOUT_MS;

-	TCCR0B = ((1 << CS01) | (1 << CS00));

-	

-	switch (V2Command)

-	{

-		case CMD_SIGN_ON:

-			V2Protocol_SignOn();

-			break;

-		case CMD_SET_PARAMETER:

-		case CMD_GET_PARAMETER:

-			V2Protocol_GetSetParam(V2Command);

-			break;

-		case CMD_LOAD_ADDRESS:

-			V2Protocol_LoadAddress();

-			break;

-		case CMD_RESET_PROTECTION:

-			V2Protocol_ResetProtection();

-			break;

-#if defined(ENABLE_ISP_PROTOCOL)

-		case CMD_ENTER_PROGMODE_ISP:

-			ISPProtocol_EnterISPMode();

-			break;

-		case CMD_LEAVE_PROGMODE_ISP:

-			ISPProtocol_LeaveISPMode();

-			break;

-		case CMD_PROGRAM_FLASH_ISP:

-		case CMD_PROGRAM_EEPROM_ISP:

-			ISPProtocol_ProgramMemory(V2Command);			

-			break;

-		case CMD_READ_FLASH_ISP:

-		case CMD_READ_EEPROM_ISP:

-			ISPProtocol_ReadMemory(V2Command);

-			break;

-		case CMD_CHIP_ERASE_ISP:

-			ISPProtocol_ChipErase();

-			break;

-		case CMD_READ_FUSE_ISP:

-		case CMD_READ_LOCK_ISP:

-		case CMD_READ_SIGNATURE_ISP:

-		case CMD_READ_OSCCAL_ISP:

-			ISPProtocol_ReadFuseLockSigOSCCAL(V2Command);

-			break;

-		case CMD_PROGRAM_FUSE_ISP:

-		case CMD_PROGRAM_LOCK_ISP:

-			ISPProtocol_WriteFuseLock(V2Command);

-			break;

-		case CMD_SPI_MULTI:

-			ISPProtocol_SPIMulti();

-			break;

-#endif

-#if defined(ENABLE_XPROG_PROTOCOL)

-		case CMD_XPROG_SETMODE:

-			XPROGProtocol_SetMode();

-			break;

-		case CMD_XPROG:

-			XPROGProtocol_Command();

-			break;

-#endif

-		default:

-			V2Protocol_UnknownCommand(V2Command);

-			break;

-	}

-	

-	/* Disable the timeout management timer */

-	TCCR0B = 0;

-

-	Endpoint_WaitUntilReady();

-	Endpoint_SelectEndpoint(AVRISP_DATA_OUT_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_OUT);

-}

-

-/** Handler for unknown V2 protocol commands. This discards all sent data and returns a

- *  STATUS_CMD_UNKNOWN status back to the host.

- *

- *  \param[in] V2Command  Issued V2 Protocol command byte from the host

- */

-static void V2Protocol_UnknownCommand(const uint8_t V2Command)

-{

-	/* Discard all incoming data */

-	while (Endpoint_BytesInEndpoint() == AVRISP_DATA_EPSIZE)

-	{

-		Endpoint_ClearOUT();

-		Endpoint_WaitUntilReady();

-	}

-

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-

-	Endpoint_Write_Byte(V2Command);

-	Endpoint_Write_Byte(STATUS_CMD_UNKNOWN);

-	Endpoint_ClearIN();

-}

-

-/** Handler for the CMD_SIGN_ON command, returning the programmer ID string to the host. */

-static void V2Protocol_SignOn(void)

-{

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-

-	Endpoint_Write_Byte(CMD_SIGN_ON);

-	Endpoint_Write_Byte(STATUS_CMD_OK);

-	Endpoint_Write_Byte(sizeof(PROGRAMMER_ID) - 1);

-	Endpoint_Write_Stream_LE(PROGRAMMER_ID, (sizeof(PROGRAMMER_ID) - 1), NO_STREAM_CALLBACK);

-	Endpoint_ClearIN();

-}

-

-/** Handler for the CMD_RESET_PROTECTION command, implemented as a dummy ACK function as

- *  no target short-circuit protection is currently implemented.

- */

-static void V2Protocol_ResetProtection(void)

-{

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-	

-	Endpoint_Write_Byte(CMD_RESET_PROTECTION);

-	Endpoint_Write_Byte(STATUS_CMD_OK);

-	Endpoint_ClearIN();	

-}

-

-

-/** Handler for the CMD_SET_PARAMETER and CMD_GET_PARAMETER commands from the host, setting or

- *  getting a device parameter's value from the parameter table.

- *

- *  \param[in] V2Command  Issued V2 Protocol command byte from the host

- */

-static void V2Protocol_GetSetParam(const uint8_t V2Command)

-{

-	uint8_t ParamID = Endpoint_Read_Byte();

-	uint8_t ParamValue;

-	

-	if (V2Command == CMD_SET_PARAMETER)

-	  ParamValue = Endpoint_Read_Byte();

-

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-	

-	Endpoint_Write_Byte(V2Command);

-	

-	uint8_t ParamPrivs = V2Params_GetParameterPrivileges(ParamID);

-	

-	if ((V2Command == CMD_SET_PARAMETER) && (ParamPrivs & PARAM_PRIV_WRITE))

-	{

-		Endpoint_Write_Byte(STATUS_CMD_OK);

-		V2Params_SetParameterValue(ParamID, ParamValue);

-	}

-	else if ((V2Command == CMD_GET_PARAMETER) && (ParamPrivs & PARAM_PRIV_READ))

-	{

-		Endpoint_Write_Byte(STATUS_CMD_OK);

-		Endpoint_Write_Byte(V2Params_GetParameterValue(ParamID));

-	}

-	else

-	{	

-		Endpoint_Write_Byte(STATUS_CMD_FAILED);

-	}

-

-	Endpoint_ClearIN();

-}

-

-/** Handler for the CMD_LOAD_ADDRESS command, loading the given device address into a

- *  global storage variable for later use, and issuing LOAD EXTENDED ADDRESS commands

- *  to the attached device as required.

- */

-static void V2Protocol_LoadAddress(void)

-{

-	Endpoint_Read_Stream_BE(&CurrentAddress, sizeof(CurrentAddress), NO_STREAM_CALLBACK);

-

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-	

-	MustSetAddress = true;

-

-	Endpoint_Write_Byte(CMD_LOAD_ADDRESS);

-	Endpoint_Write_Byte(STATUS_CMD_OK);

-	Endpoint_ClearIN();

-}

+/*
+             LUFA Library
+     Copyright (C) Dean Camera, 2010.
+              
+  dean [at] fourwalledcubicle [dot] com
+      www.fourwalledcubicle.com
+*/
+
+/*
+  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)
+
+  Permission to use, copy, modify, distribute, and sell this 
+  software and its documentation for any purpose is hereby granted
+  without fee, provided that the above copyright notice appear in 
+  all copies and that both that the copyright notice and this
+  permission notice and warranty disclaimer appear in supporting 
+  documentation, and that the name of the author not be used in 
+  advertising or publicity pertaining to distribution of the 
+  software without specific, written prior permission.
+
+  The author disclaim all warranties with regard to this
+  software, including all implied warranties of merchantability
+  and fitness.  In no event shall the author be liable for any
+  special, indirect or consequential damages or any damages
+  whatsoever resulting from loss of use, data or profits, whether
+  in an action of contract, negligence or other tortious action,
+  arising out of or in connection with the use or performance of
+  this software.
+*/
+
+/** \file
+ *
+ *  V2Protocol handler, to process V2 Protocol commands used in Atmel programmer devices.
+ */
+
+#define  INCLUDE_FROM_V2PROTOCOL_C
+#include "V2Protocol.h"
+
+/** Current memory address for FLASH/EEPROM memory read/write commands */
+uint32_t CurrentAddress;
+
+/** Flag to indicate that the next read/write operation must update the device's current address */
+bool MustSetAddress;
+
+
+/** ISR to manage timeouts whilst processing a V2Protocol command */
+ISR(TIMER0_COMPA_vect, ISR_NOBLOCK)
+{
+	if (TimeoutMSRemaining)
+	  TimeoutMSRemaining--;
+}
+
+/** Initializes the hardware and software associated with the V2 protocol command handling. */
+void V2Protocol_Init(void)
+{
+	#if defined(ADC)
+	/* Initialize the ADC converter for VTARGET level detection on supported AVR models */
+	ADC_Init(ADC_FREE_RUNNING | ADC_PRESCALE_128);
+	ADC_SetupChannel(VTARGET_ADC_CHANNEL);
+	ADC_StartReading(VTARGET_ADC_CHANNEL_MASK | ADC_RIGHT_ADJUSTED | ADC_REFERENCE_AVCC);
+	#endif
+	
+	/* Millisecond timer initialization for managing the command timeout counter */
+	OCR0A  = ((F_CPU / 64) / 1000);
+	TCCR0A = (1 << WGM01);
+	TIMSK0 = (1 << OCIE0A);
+	
+	V2Params_LoadNonVolatileParamValues();
+}
+
+/** Master V2 Protocol packet handler, for received V2 Protocol packets from a connected host.
+ *  This routine decodes the issued command and passes off the handling of the command to the
+ *  appropriate function.
+ */
+void V2Protocol_ProcessCommand(void)
+{
+	uint8_t V2Command = Endpoint_Read_Byte();
+	
+	/* Start the timeout management timer */
+	TimeoutMSRemaining = COMMAND_TIMEOUT_MS;
+	TCCR0B = ((1 << CS01) | (1 << CS00));
+	
+	switch (V2Command)
+	{
+		case CMD_SIGN_ON:
+			V2Protocol_SignOn();
+			break;
+		case CMD_SET_PARAMETER:
+		case CMD_GET_PARAMETER:
+			V2Protocol_GetSetParam(V2Command);
+			break;
+		case CMD_LOAD_ADDRESS:
+			V2Protocol_LoadAddress();
+			break;
+		case CMD_RESET_PROTECTION:
+			V2Protocol_ResetProtection();
+			break;
+#if defined(ENABLE_ISP_PROTOCOL)
+		case CMD_ENTER_PROGMODE_ISP:
+			ISPProtocol_EnterISPMode();
+			break;
+		case CMD_LEAVE_PROGMODE_ISP:
+			ISPProtocol_LeaveISPMode();
+			break;
+		case CMD_PROGRAM_FLASH_ISP:
+		case CMD_PROGRAM_EEPROM_ISP:
+			ISPProtocol_ProgramMemory(V2Command);			
+			break;
+		case CMD_READ_FLASH_ISP:
+		case CMD_READ_EEPROM_ISP:
+			ISPProtocol_ReadMemory(V2Command);
+			break;
+		case CMD_CHIP_ERASE_ISP:
+			ISPProtocol_ChipErase();
+			break;
+		case CMD_READ_FUSE_ISP:
+		case CMD_READ_LOCK_ISP:
+		case CMD_READ_SIGNATURE_ISP:
+		case CMD_READ_OSCCAL_ISP:
+			ISPProtocol_ReadFuseLockSigOSCCAL(V2Command);
+			break;
+		case CMD_PROGRAM_FUSE_ISP:
+		case CMD_PROGRAM_LOCK_ISP:
+			ISPProtocol_WriteFuseLock(V2Command);
+			break;
+		case CMD_SPI_MULTI:
+			ISPProtocol_SPIMulti();
+			break;
+#endif
+#if defined(ENABLE_XPROG_PROTOCOL)
+		case CMD_XPROG_SETMODE:
+			XPROGProtocol_SetMode();
+			break;
+		case CMD_XPROG:
+			XPROGProtocol_Command();
+			break;
+#endif
+		default:
+			V2Protocol_UnknownCommand(V2Command);
+			break;
+	}
+	
+	/* Disable the timeout management timer */
+	TCCR0B = 0;
+
+	Endpoint_WaitUntilReady();
+	Endpoint_SelectEndpoint(AVRISP_DATA_OUT_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_OUT);
+}
+
+/** Handler for unknown V2 protocol commands. This discards all sent data and returns a
+ *  STATUS_CMD_UNKNOWN status back to the host.
+ *
+ *  \param[in] V2Command  Issued V2 Protocol command byte from the host
+ */
+static void V2Protocol_UnknownCommand(const uint8_t V2Command)
+{
+	/* Discard all incoming data */
+	while (Endpoint_BytesInEndpoint() == AVRISP_DATA_EPSIZE)
+	{
+		Endpoint_ClearOUT();
+		Endpoint_WaitUntilReady();
+	}
+
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+
+	Endpoint_Write_Byte(V2Command);
+	Endpoint_Write_Byte(STATUS_CMD_UNKNOWN);
+	Endpoint_ClearIN();
+}
+
+/** Handler for the CMD_SIGN_ON command, returning the programmer ID string to the host. */
+static void V2Protocol_SignOn(void)
+{
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+
+	Endpoint_Write_Byte(CMD_SIGN_ON);
+	Endpoint_Write_Byte(STATUS_CMD_OK);
+	Endpoint_Write_Byte(sizeof(PROGRAMMER_ID) - 1);
+	Endpoint_Write_Stream_LE(PROGRAMMER_ID, (sizeof(PROGRAMMER_ID) - 1), NO_STREAM_CALLBACK);
+	Endpoint_ClearIN();
+}
+
+/** Handler for the CMD_RESET_PROTECTION command, implemented as a dummy ACK function as
+ *  no target short-circuit protection is currently implemented.
+ */
+static void V2Protocol_ResetProtection(void)
+{
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+	
+	Endpoint_Write_Byte(CMD_RESET_PROTECTION);
+	Endpoint_Write_Byte(STATUS_CMD_OK);
+	Endpoint_ClearIN();	
+}
+
+
+/** Handler for the CMD_SET_PARAMETER and CMD_GET_PARAMETER commands from the host, setting or
+ *  getting a device parameter's value from the parameter table.
+ *
+ *  \param[in] V2Command  Issued V2 Protocol command byte from the host
+ */
+static void V2Protocol_GetSetParam(const uint8_t V2Command)
+{
+	uint8_t ParamID = Endpoint_Read_Byte();
+	uint8_t ParamValue;
+	
+	if (V2Command == CMD_SET_PARAMETER)
+	  ParamValue = Endpoint_Read_Byte();
+
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+	
+	Endpoint_Write_Byte(V2Command);
+	
+	uint8_t ParamPrivs = V2Params_GetParameterPrivileges(ParamID);
+	
+	if ((V2Command == CMD_SET_PARAMETER) && (ParamPrivs & PARAM_PRIV_WRITE))
+	{
+		Endpoint_Write_Byte(STATUS_CMD_OK);
+		V2Params_SetParameterValue(ParamID, ParamValue);
+	}
+	else if ((V2Command == CMD_GET_PARAMETER) && (ParamPrivs & PARAM_PRIV_READ))
+	{
+		Endpoint_Write_Byte(STATUS_CMD_OK);
+		Endpoint_Write_Byte(V2Params_GetParameterValue(ParamID));
+	}
+	else
+	{	
+		Endpoint_Write_Byte(STATUS_CMD_FAILED);
+	}
+
+	Endpoint_ClearIN();
+}
+
+/** Handler for the CMD_LOAD_ADDRESS command, loading the given device address into a
+ *  global storage variable for later use, and issuing LOAD EXTENDED ADDRESS commands
+ *  to the attached device as required.
+ */
+static void V2Protocol_LoadAddress(void)
+{
+	Endpoint_Read_Stream_BE(&CurrentAddress, sizeof(CurrentAddress), NO_STREAM_CALLBACK);
+
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+	
+	MustSetAddress = true;
+
+	Endpoint_Write_Byte(CMD_LOAD_ADDRESS);
+	Endpoint_Write_Byte(STATUS_CMD_OK);
+	Endpoint_ClearIN();
+}
diff --git a/Projects/AVRISP-MKII/Lib/V2Protocol.h b/Projects/AVRISP-MKII/Lib/V2Protocol.h
index 7ad896da8..0f0794b5c 100644
--- a/Projects/AVRISP-MKII/Lib/V2Protocol.h
+++ b/Projects/AVRISP-MKII/Lib/V2Protocol.h
@@ -1,105 +1,105 @@
-/*

-             LUFA Library

-     Copyright (C) Dean Camera, 2010.

-              

-  dean [at] fourwalledcubicle [dot] com

-      www.fourwalledcubicle.com

-*/

-

-/*

-  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)

-

-  Permission to use, copy, modify, distribute, and sell this 

-  software and its documentation for any purpose is hereby granted

-  without fee, provided that the above copyright notice appear in 

-  all copies and that both that the copyright notice and this

-  permission notice and warranty disclaimer appear in supporting 

-  documentation, and that the name of the author not be used in 

-  advertising or publicity pertaining to distribution of the 

-  software without specific, written prior permission.

-

-  The author disclaim all warranties with regard to this

-  software, including all implied warranties of merchantability

-  and fitness.  In no event shall the author be liable for any

-  special, indirect or consequential damages or any damages

-  whatsoever resulting from loss of use, data or profits, whether

-  in an action of contract, negligence or other tortious action,

-  arising out of or in connection with the use or performance of

-  this software.

-*/

-

-/** \file

- *

- *  Header file for V2Protocol.c.

- */

-

-#ifndef _V2_PROTOCOL_

-#define _V2_PROTOCOL_

-

-	/* Includes: */

-		#if !defined(__ASSEMBLER__)

-			#include <LUFA/Drivers/USB/USB.h>

-			#include <LUFA/Drivers/Peripheral/SPI.h>

-			

-			#include "../Descriptors.h"

-			#include "V2ProtocolConstants.h"

-			#include "V2ProtocolParams.h"

-			#include "ISP/ISPProtocol.h"

-			#include "XPROG/XPROGProtocol.h"

-		#endif

-

-	/* Preprocessor Checks: */

-		#if ((BOARD == BOARD_XPLAIN) || (BOARD == BOARD_XPLAIN_REV1))

-			#undef ENABLE_ISP_PROTOCOL

-			

-			#if !defined(ENABLE_XPROG_PROTOCOL)

-				#define ENABLE_XPROG_PROTOCOL

-			#endif

-		#endif

-

-	/* Macros: */

-		#if !defined(__DOXYGEN__)

-			#define _GETADCMUXMASK2(x, y)       x ## y

-			#define _GETADCMUXMASK(x, y)        _GETADCMUXMASK2(x, y)

-		#endif

-

-		/** Programmer ID string, returned to the host during the CMD_SIGN_ON command processing */

-		#define PROGRAMMER_ID              "AVRISP_MK2"

-		

-		/** Timeout period for each issued command from the host before it is aborted */

-		#define COMMAND_TIMEOUT_MS         200

-		

-		/** Command timeout counter register, GPIOR for speed */

-		#define TimeoutMSRemaining         GPIOR0

-

-		/** MUX mask for the VTARGET ADC channel number */

-		#define VTARGET_ADC_CHANNEL_MASK   _GETADCMUXMASK(ADC_CHANNEL, VTARGET_ADC_CHANNEL)

-		

-		#if !defined(WIN_AVRDUDE_COMPAT)

-			#define SELECT_DATA_OUT_ENDPOINT() Endpoint_SetEndpointDirection(ENDPOINT_DIR_OUT);

-		#else

-			#define SELECT_DATA_OUT_ENDPOINT() Endpoint_SelectEndpoint();

-		#endif

-

-	/* External Variables: */

-		#if !defined(__ASSEMBLER__)

-			extern uint32_t CurrentAddress;

-			extern bool     MustSetAddress;

-		#endif

-

-	/* Function Prototypes: */

-		#if !defined(__ASSEMBLER__)

-			void V2Protocol_Init(void);

-			void V2Protocol_ProcessCommand(void);

-			

-			#if defined(INCLUDE_FROM_V2PROTOCOL_C)

-				static void V2Protocol_UnknownCommand(const uint8_t V2Command);

-				static void V2Protocol_SignOn(void);

-				static void V2Protocol_GetSetParam(const uint8_t V2Command);

-				static void V2Protocol_ResetProtection(void);

-				static void V2Protocol_LoadAddress(void);

-			#endif

-		#endif

-

-#endif

-

+/*
+             LUFA Library
+     Copyright (C) Dean Camera, 2010.
+              
+  dean [at] fourwalledcubicle [dot] com
+      www.fourwalledcubicle.com
+*/
+
+/*
+  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)
+
+  Permission to use, copy, modify, distribute, and sell this 
+  software and its documentation for any purpose is hereby granted
+  without fee, provided that the above copyright notice appear in 
+  all copies and that both that the copyright notice and this
+  permission notice and warranty disclaimer appear in supporting 
+  documentation, and that the name of the author not be used in 
+  advertising or publicity pertaining to distribution of the 
+  software without specific, written prior permission.
+
+  The author disclaim all warranties with regard to this
+  software, including all implied warranties of merchantability
+  and fitness.  In no event shall the author be liable for any
+  special, indirect or consequential damages or any damages
+  whatsoever resulting from loss of use, data or profits, whether
+  in an action of contract, negligence or other tortious action,
+  arising out of or in connection with the use or performance of
+  this software.
+*/
+
+/** \file
+ *
+ *  Header file for V2Protocol.c.
+ */
+
+#ifndef _V2_PROTOCOL_
+#define _V2_PROTOCOL_
+
+	/* Includes: */
+		#if !defined(__ASSEMBLER__)
+			#include <LUFA/Drivers/USB/USB.h>
+			#include <LUFA/Drivers/Peripheral/SPI.h>
+			
+			#include "../Descriptors.h"
+			#include "V2ProtocolConstants.h"
+			#include "V2ProtocolParams.h"
+			#include "ISP/ISPProtocol.h"
+			#include "XPROG/XPROGProtocol.h"
+		#endif
+
+	/* Preprocessor Checks: */
+		#if ((BOARD == BOARD_XPLAIN) || (BOARD == BOARD_XPLAIN_REV1))
+			#undef ENABLE_ISP_PROTOCOL
+			
+			#if !defined(ENABLE_XPROG_PROTOCOL)
+				#define ENABLE_XPROG_PROTOCOL
+			#endif
+		#endif
+
+	/* Macros: */
+		#if !defined(__DOXYGEN__)
+			#define _GETADCMUXMASK2(x, y)       x ## y
+			#define _GETADCMUXMASK(x, y)        _GETADCMUXMASK2(x, y)
+		#endif
+
+		/** Programmer ID string, returned to the host during the CMD_SIGN_ON command processing */
+		#define PROGRAMMER_ID              "AVRISP_MK2"
+		
+		/** Timeout period for each issued command from the host before it is aborted */
+		#define COMMAND_TIMEOUT_MS         200
+		
+		/** Command timeout counter register, GPIOR for speed */
+		#define TimeoutMSRemaining         GPIOR0
+
+		/** MUX mask for the VTARGET ADC channel number */
+		#define VTARGET_ADC_CHANNEL_MASK   _GETADCMUXMASK(ADC_CHANNEL, VTARGET_ADC_CHANNEL)
+		
+		#if !defined(WIN_AVRDUDE_COMPAT)
+			#define SELECT_DATA_OUT_ENDPOINT() Endpoint_SetEndpointDirection(ENDPOINT_DIR_OUT);
+		#else
+			#define SELECT_DATA_OUT_ENDPOINT() Endpoint_SelectEndpoint();
+		#endif
+
+	/* External Variables: */
+		#if !defined(__ASSEMBLER__)
+			extern uint32_t CurrentAddress;
+			extern bool     MustSetAddress;
+		#endif
+
+	/* Function Prototypes: */
+		#if !defined(__ASSEMBLER__)
+			void V2Protocol_Init(void);
+			void V2Protocol_ProcessCommand(void);
+			
+			#if defined(INCLUDE_FROM_V2PROTOCOL_C)
+				static void V2Protocol_UnknownCommand(const uint8_t V2Command);
+				static void V2Protocol_SignOn(void);
+				static void V2Protocol_GetSetParam(const uint8_t V2Command);
+				static void V2Protocol_ResetProtection(void);
+				static void V2Protocol_LoadAddress(void);
+			#endif
+		#endif
+
+#endif
+
diff --git a/Projects/AVRISP-MKII/Lib/V2ProtocolConstants.h b/Projects/AVRISP-MKII/Lib/V2ProtocolConstants.h
index 45397403b..94c60766b 100644
--- a/Projects/AVRISP-MKII/Lib/V2ProtocolConstants.h
+++ b/Projects/AVRISP-MKII/Lib/V2ProtocolConstants.h
@@ -1,88 +1,88 @@
-/*

-             LUFA Library

-     Copyright (C) Dean Camera, 2010.

-              

-  dean [at] fourwalledcubicle [dot] com

-      www.fourwalledcubicle.com

-*/

-

-/*

-  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)

-

-  Permission to use, copy, modify, distribute, and sell this 

-  software and its documentation for any purpose is hereby granted

-  without fee, provided that the above copyright notice appear in 

-  all copies and that both that the copyright notice and this

-  permission notice and warranty disclaimer appear in supporting 

-  documentation, and that the name of the author not be used in 

-  advertising or publicity pertaining to distribution of the 

-  software without specific, written prior permission.

-

-  The author disclaim all warranties with regard to this

-  software, including all implied warranties of merchantability

-  and fitness.  In no event shall the author be liable for any

-  special, indirect or consequential damages or any damages

-  whatsoever resulting from loss of use, data or profits, whether

-  in an action of contract, negligence or other tortious action,

-  arising out of or in connection with the use or performance of

-  this software.

-*/

-

-/** \file

- *

- *  Macros for the V2 Protocol Packet Commands and Responses.

- */

-

-#ifndef _V2_PROTOCOL_CONSTANTS_

-#define _V2_PROTOCOL_CONSTANTS_

-

-	/* Macros: */

-		#define CMD_SIGN_ON                 0x01

-		#define CMD_SET_PARAMETER           0x02

-		#define CMD_GET_PARAMETER           0x03

-		#define CMD_OSCCAL                  0x05

-		#define CMD_LOAD_ADDRESS            0x06

-		#define CMD_FIRMWARE_UPGRADE        0x07

-		#define CMD_RESET_PROTECTION        0x0A

-		#define CMD_ENTER_PROGMODE_ISP      0x10

-		#define CMD_LEAVE_PROGMODE_ISP      0x11

-		#define CMD_CHIP_ERASE_ISP          0x12

-		#define CMD_PROGRAM_FLASH_ISP       0x13

-		#define CMD_READ_FLASH_ISP          0x14

-		#define CMD_PROGRAM_EEPROM_ISP      0x15

-		#define CMD_READ_EEPROM_ISP         0x16

-		#define CMD_PROGRAM_FUSE_ISP        0x17

-		#define CMD_READ_FUSE_ISP           0x18

-		#define CMD_PROGRAM_LOCK_ISP        0x19

-		#define CMD_READ_LOCK_ISP           0x1A

-		#define CMD_READ_SIGNATURE_ISP      0x1B

-		#define CMD_READ_OSCCAL_ISP         0x1C

-		#define CMD_SPI_MULTI               0x1D

-		#define CMD_XPROG                   0x50

-		#define CMD_XPROG_SETMODE           0x51

-

-		#define STATUS_CMD_OK               0x00

-		#define STATUS_CMD_TOUT             0x80

-		#define STATUS_RDY_BSY_TOUT         0x81

-		#define STATUS_SET_PARAM_MISSING    0x82

-		#define STATUS_CMD_FAILED           0xC0

-		#define STATUS_CMD_UNKNOWN          0xC9

-		#define STATUS_ISP_READY            0x00

-		#define STATUS_CONN_FAIL_MOSI       0x01

-		#define STATUS_CONN_FAIL_RST        0x02

-		#define STATUS_CONN_FAIL_SCK        0x04

-		#define STATUS_TGT_NOT_DETECTED     0x10

-		#define STATUS_TGT_REVERSE_INSERTED 0x20

-

-		#define PARAM_BUILD_NUMBER_LOW      0x80

-		#define PARAM_BUILD_NUMBER_HIGH     0x81

-		#define PARAM_HW_VER                0x90

-		#define PARAM_SW_MAJOR              0x91

-		#define PARAM_SW_MINOR              0x92

-		#define PARAM_VTARGET               0x94

-		#define PARAM_SCK_DURATION          0x98

-		#define PARAM_RESET_POLARITY        0x9E

-		#define PARAM_STATUS_TGT_CONN       0xA1

-		#define PARAM_DISCHARGEDELAY        0xA4

-

-#endif

+/*
+             LUFA Library
+     Copyright (C) Dean Camera, 2010.
+              
+  dean [at] fourwalledcubicle [dot] com
+      www.fourwalledcubicle.com
+*/
+
+/*
+  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)
+
+  Permission to use, copy, modify, distribute, and sell this 
+  software and its documentation for any purpose is hereby granted
+  without fee, provided that the above copyright notice appear in 
+  all copies and that both that the copyright notice and this
+  permission notice and warranty disclaimer appear in supporting 
+  documentation, and that the name of the author not be used in 
+  advertising or publicity pertaining to distribution of the 
+  software without specific, written prior permission.
+
+  The author disclaim all warranties with regard to this
+  software, including all implied warranties of merchantability
+  and fitness.  In no event shall the author be liable for any
+  special, indirect or consequential damages or any damages
+  whatsoever resulting from loss of use, data or profits, whether
+  in an action of contract, negligence or other tortious action,
+  arising out of or in connection with the use or performance of
+  this software.
+*/
+
+/** \file
+ *
+ *  Macros for the V2 Protocol Packet Commands and Responses.
+ */
+
+#ifndef _V2_PROTOCOL_CONSTANTS_
+#define _V2_PROTOCOL_CONSTANTS_
+
+	/* Macros: */
+		#define CMD_SIGN_ON                 0x01
+		#define CMD_SET_PARAMETER           0x02
+		#define CMD_GET_PARAMETER           0x03
+		#define CMD_OSCCAL                  0x05
+		#define CMD_LOAD_ADDRESS            0x06
+		#define CMD_FIRMWARE_UPGRADE        0x07
+		#define CMD_RESET_PROTECTION        0x0A
+		#define CMD_ENTER_PROGMODE_ISP      0x10
+		#define CMD_LEAVE_PROGMODE_ISP      0x11
+		#define CMD_CHIP_ERASE_ISP          0x12
+		#define CMD_PROGRAM_FLASH_ISP       0x13
+		#define CMD_READ_FLASH_ISP          0x14
+		#define CMD_PROGRAM_EEPROM_ISP      0x15
+		#define CMD_READ_EEPROM_ISP         0x16
+		#define CMD_PROGRAM_FUSE_ISP        0x17
+		#define CMD_READ_FUSE_ISP           0x18
+		#define CMD_PROGRAM_LOCK_ISP        0x19
+		#define CMD_READ_LOCK_ISP           0x1A
+		#define CMD_READ_SIGNATURE_ISP      0x1B
+		#define CMD_READ_OSCCAL_ISP         0x1C
+		#define CMD_SPI_MULTI               0x1D
+		#define CMD_XPROG                   0x50
+		#define CMD_XPROG_SETMODE           0x51
+
+		#define STATUS_CMD_OK               0x00
+		#define STATUS_CMD_TOUT             0x80
+		#define STATUS_RDY_BSY_TOUT         0x81
+		#define STATUS_SET_PARAM_MISSING    0x82
+		#define STATUS_CMD_FAILED           0xC0
+		#define STATUS_CMD_UNKNOWN          0xC9
+		#define STATUS_ISP_READY            0x00
+		#define STATUS_CONN_FAIL_MOSI       0x01
+		#define STATUS_CONN_FAIL_RST        0x02
+		#define STATUS_CONN_FAIL_SCK        0x04
+		#define STATUS_TGT_NOT_DETECTED     0x10
+		#define STATUS_TGT_REVERSE_INSERTED 0x20
+
+		#define PARAM_BUILD_NUMBER_LOW      0x80
+		#define PARAM_BUILD_NUMBER_HIGH     0x81
+		#define PARAM_HW_VER                0x90
+		#define PARAM_SW_MAJOR              0x91
+		#define PARAM_SW_MINOR              0x92
+		#define PARAM_VTARGET               0x94
+		#define PARAM_SCK_DURATION          0x98
+		#define PARAM_RESET_POLARITY        0x9E
+		#define PARAM_STATUS_TGT_CONN       0xA1
+		#define PARAM_DISCHARGEDELAY        0xA4
+
+#endif
diff --git a/Projects/AVRISP-MKII/Lib/V2ProtocolParams.c b/Projects/AVRISP-MKII/Lib/V2ProtocolParams.c
index 4d508f508..b8c5930a0 100644
--- a/Projects/AVRISP-MKII/Lib/V2ProtocolParams.c
+++ b/Projects/AVRISP-MKII/Lib/V2ProtocolParams.c
@@ -1,182 +1,182 @@
-/*

-             LUFA Library

-     Copyright (C) Dean Camera, 2010.

-              

-  dean [at] fourwalledcubicle [dot] com

-      www.fourwalledcubicle.com

-*/

-

-/*

-  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)

-

-  Permission to use, copy, modify, distribute, and sell this 

-  software and its documentation for any purpose is hereby granted

-  without fee, provided that the above copyright notice appear in 

-  all copies and that both that the copyright notice and this

-  permission notice and warranty disclaimer appear in supporting 

-  documentation, and that the name of the author not be used in 

-  advertising or publicity pertaining to distribution of the 

-  software without specific, written prior permission.

-

-  The author disclaim all warranties with regard to this

-  software, including all implied warranties of merchantability

-  and fitness.  In no event shall the author be liable for any

-  special, indirect or consequential damages or any damages

-  whatsoever resulting from loss of use, data or profits, whether

-  in an action of contract, negligence or other tortious action,

-  arising out of or in connection with the use or performance of

-  this software.

-*/

-

-/** \file

- *

- *  V2Protocol parameter handler, to process V2 Protocol device parameters.

- */

-

-#define  INCLUDE_FROM_V2PROTOCOL_PARAMS_C

-#include "V2ProtocolParams.h"

-

-/* Non-Volatile Parameter Values for EEPROM storage */

-uint8_t EEMEM EEPROM_Rest_Polarity = 0x00;

-

-/* Volatile Parameter Values for RAM storage */

-static ParameterItem_t ParameterTable[] = 

-	{

-		{ .ParamID          = PARAM_BUILD_NUMBER_LOW,

-		  .ParamPrivileges  = PARAM_PRIV_READ,

-		  .ParamValue       = (LUFA_VERSION_INTEGER >> 8)        },

-

-		{ .ParamID          = PARAM_BUILD_NUMBER_HIGH,

-		  .ParamPrivileges  = PARAM_PRIV_READ,

-		  .ParamValue       = (LUFA_VERSION_INTEGER & 0xFF),     },

-

-		{ .ParamID          = PARAM_HW_VER,

-		  .ParamPrivileges  = PARAM_PRIV_READ,

-		  .ParamValue       = 0x00                               },

-

-		{ .ParamID          = PARAM_SW_MAJOR,

-		  .ParamPrivileges  = PARAM_PRIV_READ,

-		  .ParamValue       = 0x01                               },

-

-		{ .ParamID          = PARAM_SW_MINOR,

-		  .ParamPrivileges  = PARAM_PRIV_READ,

-		  .ParamValue       = 0x0D                               },

-

-		{ .ParamID          = PARAM_VTARGET,

-		  .ParamPrivileges  = PARAM_PRIV_READ,

-		  .ParamValue       = 0x32                               },

-

-		{ .ParamID          = PARAM_SCK_DURATION,

-		  .ParamPrivileges  = PARAM_PRIV_READ | PARAM_PRIV_WRITE,

-		  .ParamValue       = (TOTAL_ISP_PROGRAMMING_SPEEDS - 1) },

-

-		{ .ParamID          = PARAM_RESET_POLARITY,

-		  .ParamPrivileges  = PARAM_PRIV_WRITE,

-		  .ParamValue       = 0x00                               },

-

-		{ .ParamID          = PARAM_STATUS_TGT_CONN,

-		  .ParamPrivileges  = PARAM_PRIV_READ,

-		  .ParamValue       = STATUS_ISP_READY                   },

-

-		{ .ParamID          = PARAM_DISCHARGEDELAY,

-		  .ParamPrivileges  = PARAM_PRIV_WRITE,

-		  .ParamValue       = 0x00                               },

-	};

-

-

-/** Loads saved non-volatile parameter values from the EEPROM into the parameter table, as needed. */

-void V2Params_LoadNonVolatileParamValues(void)

-{

-	/* Target RESET line polarity is a non-volatile value, retrieve current parameter value from EEPROM -

-	 *   NB: Cannot call V2Protocol_SetParameterValue() here, as that will cause another EEPROM write! */

-	V2Params_GetParamFromTable(PARAM_RESET_POLARITY)->ParamValue = eeprom_read_byte(&EEPROM_Rest_Polarity);

-}

-

-/** Updates any parameter values that are sourced from hardware rather than explicitly set by the host, such as

- *  VTARGET levels from the ADC on supported AVR models.

- */

-void V2Params_UpdateParamValues(void)

-{

-	#if (defined(ADC) && !defined(NO_VTARGET_DETECT))

-	/* Update VTARGET parameter with the latest ADC conversion of VTARGET on supported AVR models */

-	V2Params_GetParamFromTable(PARAM_VTARGET)->ParamValue = ((5 * 10 * ADC_GetResult()) / 1024);

-	#endif

-}

-

-/** Retrieves the host PC read/write privileges for a given parameter in the parameter table. This should

- *  be called before calls to \ref V2Params_GetParameterValue() or \ref V2Params_SetParameterValue() when

- *  getting or setting parameter values in response to requests from the host.

- *

- *  \param[in] ParamID  Parameter ID whose privileges are to be retrieved from the table

- *

- *  \return Privileges for the requested parameter, as a mask of PARAM_PRIV_* masks

- */ 

-uint8_t V2Params_GetParameterPrivileges(const uint8_t ParamID)

-{

-	ParameterItem_t* ParamInfo = V2Params_GetParamFromTable(ParamID);

-	

-	if (ParamInfo == NULL)

-	  return 0;

-

-	return ParamInfo->ParamPrivileges;

-}

-

-/** Retrieves the current value for a given parameter in the parameter table.

- *

- *  \param[in] ParamID  Parameter ID whose value is to be retrieved from the table

- *

- *  \return Current value of the parameter in the table, or 0 if not found

- */ 

-uint8_t V2Params_GetParameterValue(const uint8_t ParamID)

-{

-	ParameterItem_t* ParamInfo = V2Params_GetParamFromTable(ParamID);

-	

-	if (ParamInfo == NULL)

-	  return 0;

-	

-	return ParamInfo->ParamValue;

-}

-

-/** Sets the value for a given parameter in the parameter table.

- *

- *  \param[in] ParamID  Parameter ID whose value is to be set in the table

- *  \param[in] Value    New value to set the parameter to

- *

- *  \return Pointer to the associated parameter information from the parameter table if found, NULL otherwise

- */

-void V2Params_SetParameterValue(const uint8_t ParamID, const uint8_t Value)

-{

-	ParameterItem_t* ParamInfo = V2Params_GetParamFromTable(ParamID);

-

-	if (ParamInfo == NULL)

-	  return;

-

-	ParamInfo->ParamValue = Value;

-

-	/* The target RESET line polarity is a non-volatile parameter, save to EEPROM when changed */

-	if (ParamID == PARAM_RESET_POLARITY)

-	  eeprom_write_byte(&EEPROM_Rest_Polarity, Value);  

-}

-

-/** Retrieves a parameter entry (including ID, value and privileges) from the parameter table that matches the given

- *  parameter ID.

- *

- *  \param[in] ParamID  Parameter ID to find in the table

- *

- *  \return Pointer to the associated parameter information from the parameter table if found, NULL otherwise

- */

-static ParameterItem_t* V2Params_GetParamFromTable(const uint8_t ParamID)

-{

-	ParameterItem_t* CurrTableItem = ParameterTable;

-

-	/* Find the parameter in the parameter table if present */

-	for (uint8_t TableIndex = 0; TableIndex < TABLE_PARAM_COUNT; TableIndex++)

-	{

-		if (ParamID == CurrTableItem->ParamID)

-		  return CurrTableItem;

-		

-		CurrTableItem++;

-	}

-

-	return NULL;

-}

+/*
+             LUFA Library
+     Copyright (C) Dean Camera, 2010.
+              
+  dean [at] fourwalledcubicle [dot] com
+      www.fourwalledcubicle.com
+*/
+
+/*
+  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)
+
+  Permission to use, copy, modify, distribute, and sell this 
+  software and its documentation for any purpose is hereby granted
+  without fee, provided that the above copyright notice appear in 
+  all copies and that both that the copyright notice and this
+  permission notice and warranty disclaimer appear in supporting 
+  documentation, and that the name of the author not be used in 
+  advertising or publicity pertaining to distribution of the 
+  software without specific, written prior permission.
+
+  The author disclaim all warranties with regard to this
+  software, including all implied warranties of merchantability
+  and fitness.  In no event shall the author be liable for any
+  special, indirect or consequential damages or any damages
+  whatsoever resulting from loss of use, data or profits, whether
+  in an action of contract, negligence or other tortious action,
+  arising out of or in connection with the use or performance of
+  this software.
+*/
+
+/** \file
+ *
+ *  V2Protocol parameter handler, to process V2 Protocol device parameters.
+ */
+
+#define  INCLUDE_FROM_V2PROTOCOL_PARAMS_C
+#include "V2ProtocolParams.h"
+
+/* Non-Volatile Parameter Values for EEPROM storage */
+uint8_t EEMEM EEPROM_Rest_Polarity = 0x00;
+
+/* Volatile Parameter Values for RAM storage */
+static ParameterItem_t ParameterTable[] = 
+	{
+		{ .ParamID          = PARAM_BUILD_NUMBER_LOW,
+		  .ParamPrivileges  = PARAM_PRIV_READ,
+		  .ParamValue       = (LUFA_VERSION_INTEGER >> 8)        },
+
+		{ .ParamID          = PARAM_BUILD_NUMBER_HIGH,
+		  .ParamPrivileges  = PARAM_PRIV_READ,
+		  .ParamValue       = (LUFA_VERSION_INTEGER & 0xFF),     },
+
+		{ .ParamID          = PARAM_HW_VER,
+		  .ParamPrivileges  = PARAM_PRIV_READ,
+		  .ParamValue       = 0x00                               },
+
+		{ .ParamID          = PARAM_SW_MAJOR,
+		  .ParamPrivileges  = PARAM_PRIV_READ,
+		  .ParamValue       = 0x01                               },
+
+		{ .ParamID          = PARAM_SW_MINOR,
+		  .ParamPrivileges  = PARAM_PRIV_READ,
+		  .ParamValue       = 0x0D                               },
+
+		{ .ParamID          = PARAM_VTARGET,
+		  .ParamPrivileges  = PARAM_PRIV_READ,
+		  .ParamValue       = 0x32                               },
+
+		{ .ParamID          = PARAM_SCK_DURATION,
+		  .ParamPrivileges  = PARAM_PRIV_READ | PARAM_PRIV_WRITE,
+		  .ParamValue       = (TOTAL_ISP_PROGRAMMING_SPEEDS - 1) },
+
+		{ .ParamID          = PARAM_RESET_POLARITY,
+		  .ParamPrivileges  = PARAM_PRIV_WRITE,
+		  .ParamValue       = 0x00                               },
+
+		{ .ParamID          = PARAM_STATUS_TGT_CONN,
+		  .ParamPrivileges  = PARAM_PRIV_READ,
+		  .ParamValue       = STATUS_ISP_READY                   },
+
+		{ .ParamID          = PARAM_DISCHARGEDELAY,
+		  .ParamPrivileges  = PARAM_PRIV_WRITE,
+		  .ParamValue       = 0x00                               },
+	};
+
+
+/** Loads saved non-volatile parameter values from the EEPROM into the parameter table, as needed. */
+void V2Params_LoadNonVolatileParamValues(void)
+{
+	/* Target RESET line polarity is a non-volatile value, retrieve current parameter value from EEPROM -
+	 *   NB: Cannot call V2Protocol_SetParameterValue() here, as that will cause another EEPROM write! */
+	V2Params_GetParamFromTable(PARAM_RESET_POLARITY)->ParamValue = eeprom_read_byte(&EEPROM_Rest_Polarity);
+}
+
+/** Updates any parameter values that are sourced from hardware rather than explicitly set by the host, such as
+ *  VTARGET levels from the ADC on supported AVR models.
+ */
+void V2Params_UpdateParamValues(void)
+{
+	#if (defined(ADC) && !defined(NO_VTARGET_DETECT))
+	/* Update VTARGET parameter with the latest ADC conversion of VTARGET on supported AVR models */
+	V2Params_GetParamFromTable(PARAM_VTARGET)->ParamValue = ((5 * 10 * ADC_GetResult()) / 1024);
+	#endif
+}
+
+/** Retrieves the host PC read/write privileges for a given parameter in the parameter table. This should
+ *  be called before calls to \ref V2Params_GetParameterValue() or \ref V2Params_SetParameterValue() when
+ *  getting or setting parameter values in response to requests from the host.
+ *
+ *  \param[in] ParamID  Parameter ID whose privileges are to be retrieved from the table
+ *
+ *  \return Privileges for the requested parameter, as a mask of PARAM_PRIV_* masks
+ */ 
+uint8_t V2Params_GetParameterPrivileges(const uint8_t ParamID)
+{
+	ParameterItem_t* ParamInfo = V2Params_GetParamFromTable(ParamID);
+	
+	if (ParamInfo == NULL)
+	  return 0;
+
+	return ParamInfo->ParamPrivileges;
+}
+
+/** Retrieves the current value for a given parameter in the parameter table.
+ *
+ *  \param[in] ParamID  Parameter ID whose value is to be retrieved from the table
+ *
+ *  \return Current value of the parameter in the table, or 0 if not found
+ */ 
+uint8_t V2Params_GetParameterValue(const uint8_t ParamID)
+{
+	ParameterItem_t* ParamInfo = V2Params_GetParamFromTable(ParamID);
+	
+	if (ParamInfo == NULL)
+	  return 0;
+	
+	return ParamInfo->ParamValue;
+}
+
+/** Sets the value for a given parameter in the parameter table.
+ *
+ *  \param[in] ParamID  Parameter ID whose value is to be set in the table
+ *  \param[in] Value    New value to set the parameter to
+ *
+ *  \return Pointer to the associated parameter information from the parameter table if found, NULL otherwise
+ */
+void V2Params_SetParameterValue(const uint8_t ParamID, const uint8_t Value)
+{
+	ParameterItem_t* ParamInfo = V2Params_GetParamFromTable(ParamID);
+
+	if (ParamInfo == NULL)
+	  return;
+
+	ParamInfo->ParamValue = Value;
+
+	/* The target RESET line polarity is a non-volatile parameter, save to EEPROM when changed */
+	if (ParamID == PARAM_RESET_POLARITY)
+	  eeprom_write_byte(&EEPROM_Rest_Polarity, Value);  
+}
+
+/** Retrieves a parameter entry (including ID, value and privileges) from the parameter table that matches the given
+ *  parameter ID.
+ *
+ *  \param[in] ParamID  Parameter ID to find in the table
+ *
+ *  \return Pointer to the associated parameter information from the parameter table if found, NULL otherwise
+ */
+static ParameterItem_t* V2Params_GetParamFromTable(const uint8_t ParamID)
+{
+	ParameterItem_t* CurrTableItem = ParameterTable;
+
+	/* Find the parameter in the parameter table if present */
+	for (uint8_t TableIndex = 0; TableIndex < TABLE_PARAM_COUNT; TableIndex++)
+	{
+		if (ParamID == CurrTableItem->ParamID)
+		  return CurrTableItem;
+		
+		CurrTableItem++;
+	}
+
+	return NULL;
+}
diff --git a/Projects/AVRISP-MKII/Lib/V2ProtocolParams.h b/Projects/AVRISP-MKII/Lib/V2ProtocolParams.h
index 995468a4d..4bbb02419 100644
--- a/Projects/AVRISP-MKII/Lib/V2ProtocolParams.h
+++ b/Projects/AVRISP-MKII/Lib/V2ProtocolParams.h
@@ -1,85 +1,85 @@
-/*

-             LUFA Library

-     Copyright (C) Dean Camera, 2010.

-              

-  dean [at] fourwalledcubicle [dot] com

-      www.fourwalledcubicle.com

-*/

-

-/*

-  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)

-

-  Permission to use, copy, modify, distribute, and sell this 

-  software and its documentation for any purpose is hereby granted

-  without fee, provided that the above copyright notice appear in 

-  all copies and that both that the copyright notice and this

-  permission notice and warranty disclaimer appear in supporting 

-  documentation, and that the name of the author not be used in 

-  advertising or publicity pertaining to distribution of the 

-  software without specific, written prior permission.

-

-  The author disclaim all warranties with regard to this

-  software, including all implied warranties of merchantability

-  and fitness.  In no event shall the author be liable for any

-  special, indirect or consequential damages or any damages

-  whatsoever resulting from loss of use, data or profits, whether

-  in an action of contract, negligence or other tortious action,

-  arising out of or in connection with the use or performance of

-  this software.

-*/

-

-/** \file

- *

- *  Header file for V2ProtocolParams.c.

- */

-

-#ifndef _V2_PROTOCOL_PARAMS_

-#define _V2_PROTOCOL_PARAMS_

-

-	/* Includes: */

-		#include <avr/io.h>

-		#include <avr/eeprom.h>

-

-		#include <LUFA/Version.h>

-

-		#if defined(ADC)

-			#include <LUFA/Drivers/Peripheral/ADC.h>

-		#endif

-		

-		#include "V2Protocol.h"

-		#include "V2ProtocolConstants.h"

-		#include "ISP/ISPTarget.h"

-

-	/* Macros: */

-		/** Parameter privilege mask to allow the host PC to read the parameter's value */

-		#define PARAM_PRIV_READ     (1 << 0)

-

-		/** Parameter privilege mask to allow the host PC to change the parameter's value */

-		#define PARAM_PRIV_WRITE    (1 << 1)

-		

-		/** Total number of parameters in the parameter table */

-		#define TABLE_PARAM_COUNT   (sizeof(ParameterTable) / sizeof(ParameterTable[0]))

-

-	/* Type Defines: */

-		/** Type define for a parameter table entry indicating a PC readable or writable device parameter. */

-		typedef struct

-		{

-			const uint8_t ParamID; /**< Parameter ID number to uniquely identify the parameter within the device */

-			const uint8_t ParamPrivileges;  /**< Parameter privileges to allow the host to read or write the parameter's value */

-			uint8_t ParamValue; /**< Current parameter's value within the device */

-		} ParameterItem_t;

-

-	/* Function Prototypes: */

-		void    V2Params_LoadNonVolatileParamValues(void);

-		void    V2Params_UpdateParamValues(void);

-	

-		uint8_t V2Params_GetParameterPrivileges(const uint8_t ParamID);

-		uint8_t V2Params_GetParameterValue(const uint8_t ParamID);

-		void    V2Params_SetParameterValue(const uint8_t ParamID, const uint8_t Value);

-		

-		#if defined(INCLUDE_FROM_V2PROTOCOL_PARAMS_C)

-			static ParameterItem_t* V2Params_GetParamFromTable(const uint8_t ParamID);

-		#endif

-

-#endif

-

+/*
+             LUFA Library
+     Copyright (C) Dean Camera, 2010.
+              
+  dean [at] fourwalledcubicle [dot] com
+      www.fourwalledcubicle.com
+*/
+
+/*
+  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)
+
+  Permission to use, copy, modify, distribute, and sell this 
+  software and its documentation for any purpose is hereby granted
+  without fee, provided that the above copyright notice appear in 
+  all copies and that both that the copyright notice and this
+  permission notice and warranty disclaimer appear in supporting 
+  documentation, and that the name of the author not be used in 
+  advertising or publicity pertaining to distribution of the 
+  software without specific, written prior permission.
+
+  The author disclaim all warranties with regard to this
+  software, including all implied warranties of merchantability
+  and fitness.  In no event shall the author be liable for any
+  special, indirect or consequential damages or any damages
+  whatsoever resulting from loss of use, data or profits, whether
+  in an action of contract, negligence or other tortious action,
+  arising out of or in connection with the use or performance of
+  this software.
+*/
+
+/** \file
+ *
+ *  Header file for V2ProtocolParams.c.
+ */
+
+#ifndef _V2_PROTOCOL_PARAMS_
+#define _V2_PROTOCOL_PARAMS_
+
+	/* Includes: */
+		#include <avr/io.h>
+		#include <avr/eeprom.h>
+
+		#include <LUFA/Version.h>
+
+		#if defined(ADC)
+			#include <LUFA/Drivers/Peripheral/ADC.h>
+		#endif
+		
+		#include "V2Protocol.h"
+		#include "V2ProtocolConstants.h"
+		#include "ISP/ISPTarget.h"
+
+	/* Macros: */
+		/** Parameter privilege mask to allow the host PC to read the parameter's value */
+		#define PARAM_PRIV_READ     (1 << 0)
+
+		/** Parameter privilege mask to allow the host PC to change the parameter's value */
+		#define PARAM_PRIV_WRITE    (1 << 1)
+		
+		/** Total number of parameters in the parameter table */
+		#define TABLE_PARAM_COUNT   (sizeof(ParameterTable) / sizeof(ParameterTable[0]))
+
+	/* Type Defines: */
+		/** Type define for a parameter table entry indicating a PC readable or writable device parameter. */
+		typedef struct
+		{
+			const uint8_t ParamID; /**< Parameter ID number to uniquely identify the parameter within the device */
+			const uint8_t ParamPrivileges;  /**< Parameter privileges to allow the host to read or write the parameter's value */
+			uint8_t ParamValue; /**< Current parameter's value within the device */
+		} ParameterItem_t;
+
+	/* Function Prototypes: */
+		void    V2Params_LoadNonVolatileParamValues(void);
+		void    V2Params_UpdateParamValues(void);
+	
+		uint8_t V2Params_GetParameterPrivileges(const uint8_t ParamID);
+		uint8_t V2Params_GetParameterValue(const uint8_t ParamID);
+		void    V2Params_SetParameterValue(const uint8_t ParamID, const uint8_t Value);
+		
+		#if defined(INCLUDE_FROM_V2PROTOCOL_PARAMS_C)
+			static ParameterItem_t* V2Params_GetParamFromTable(const uint8_t ParamID);
+		#endif
+
+#endif
+
diff --git a/Projects/AVRISP-MKII/Lib/XPROG/TINYNVM.c b/Projects/AVRISP-MKII/Lib/XPROG/TINYNVM.c
index 817f22347..f9815043f 100644
--- a/Projects/AVRISP-MKII/Lib/XPROG/TINYNVM.c
+++ b/Projects/AVRISP-MKII/Lib/XPROG/TINYNVM.c
@@ -1,238 +1,238 @@
-/*

-             LUFA Library

-     Copyright (C) Dean Camera, 2010.

-              

-  dean [at] fourwalledcubicle [dot] com

-      www.fourwalledcubicle.com

-*/

-

-/*

-  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)

-

-  Permission to use, copy, modify, distribute, and sell this 

-  software and its documentation for any purpose is hereby granted

-  without fee, provided that the above copyright notice appear in 

-  all copies and that both that the copyright notice and this

-  permission notice and warranty disclaimer appear in supporting 

-  documentation, and that the name of the author not be used in 

-  advertising or publicity pertaining to distribution of the 

-  software without specific, written prior permission.

-

-  The author disclaim all warranties with regard to this

-  software, including all implied warranties of merchantability

-  and fitness.  In no event shall the author be liable for any

-  special, indirect or consequential damages or any damages

-  whatsoever resulting from loss of use, data or profits, whether

-  in an action of contract, negligence or other tortious action,

-  arising out of or in connection with the use or performance of

-  this software.

-*/

-

-/** \file

- *

- *  Target-related functions for the TINY target's NVM module.

- */

-

-#define  INCLUDE_FROM_TINYNVM_C

-#include "TINYNVM.h"

-

-#if defined(ENABLE_XPROG_PROTOCOL) || defined(__DOXYGEN__)

-

-/** Sends the given pointer address to the target's TPI pointer register */

-static void TINYNVM_SendPointerAddress(const uint16_t AbsoluteAddress)

-{

-	/* Send the given 16-bit address to the target, LSB first */

-	XPROGTarget_SendByte(TPI_CMD_SSTPR | 0);

-	XPROGTarget_SendByte(((uint8_t*)&AbsoluteAddress)[0]);

-	XPROGTarget_SendByte(TPI_CMD_SSTPR | 1);

-	XPROGTarget_SendByte(((uint8_t*)&AbsoluteAddress)[1]);

-}

-

-/** Sends a SIN command to the target with the specified I/O address, ready for the data byte to be written.

- *

- *  \param[in] Address  6-bit I/O address to write to in the target's I/O memory space

- */

-static void TINYNVM_SendReadNVMRegister(const uint8_t Address)

-{

-	/* The TPI command for reading from the I/O space uses strange addressing, where the I/O address's upper

-	 * two bits of the 6-bit address are shifted left once */

-	XPROGTarget_SendByte(TPI_CMD_SIN | ((Address & 0x30) << 1) | (Address & 0x0F));

-}

-

-/** Sends a SOUT command to the target with the specified I/O address, ready for the data byte to be read.

- *

- *  \param[in] Address  6-bit I/O address to read from in the target's I/O memory space

- */

-static void TINYNVM_SendWriteNVMRegister(const uint8_t Address)

-{

-	/* The TPI command for reading from the I/O space uses strange addressing, where the I/O address's upper

-	 * two bits of the 6-bit address are shifted left once */

-	XPROGTarget_SendByte(TPI_CMD_SOUT | ((Address & 0x30) << 1) | (Address & 0x0F));

-}

-

-/** Busy-waits while the NVM controller is busy performing a NVM operation, such as a FLASH page read.

- *

- *  \return Boolean true if the NVM controller became ready within the timeout period, false otherwise

- */

-bool TINYNVM_WaitWhileNVMBusBusy(void)

-{

-	/* Poll the STATUS register to check to see if NVM access has been enabled */

-	while (TimeoutMSRemaining)

-	{

-		/* Send the SLDCS command to read the TPI STATUS register to see the NVM bus is active */

-		XPROGTarget_SendByte(TPI_CMD_SLDCS | TPI_STATUS_REG);

-

-		uint8_t StatusRegister = XPROGTarget_ReceiveByte();

-

-		/* We might have timed out waiting for the status register read response, check here */

-		if (!(TimeoutMSRemaining))

-		  return false;

-

-		/* Check the status register read response to see if the NVM bus is enabled */

-		if (StatusRegister & TPI_STATUS_NVM)

-		{

-			TimeoutMSRemaining = COMMAND_TIMEOUT_MS;

-			return true;

-		}

-	}

-

-	return false;

-}

-

-/** Waits while the target's NVM controller is busy performing an operation, exiting if the

- *  timeout period expires.

- *

- *  \return Boolean true if the NVM controller became ready within the timeout period, false otherwise

- */

-bool TINYNVM_WaitWhileNVMControllerBusy(void)

-{

-	/* Poll the STATUS register to check to see if NVM access has been enabled */

-	while (TimeoutMSRemaining)

-	{

-		/* Send the SIN command to read the TPI STATUS register to see the NVM bus is busy */

-		TINYNVM_SendReadNVMRegister(XPROG_Param_NVMCSRRegAddr);

-

-		uint8_t StatusRegister = XPROGTarget_ReceiveByte();

-

-		/* We might have timed out waiting for the status register read response, check here */

-		if (!(TimeoutMSRemaining))

-		  return false;

-

-		/* Check to see if the BUSY flag is still set */

-		if (!(StatusRegister & (1 << 7)))

-		{

-			TimeoutMSRemaining = COMMAND_TIMEOUT_MS;

-			return true;

-		}

-	}

-

-	return false;

-}

-

-/** Reads memory from the target's memory spaces.

- *

- *  \param[in]  ReadAddress  Start address to read from within the target's address space

- *  \param[out] ReadBuffer   Buffer to store read data into

- *  \param[in]  ReadSize     Length of the data to read from the device

- *

- *  \return Boolean true if the command sequence complete successfully

- */

-bool TINYNVM_ReadMemory(const uint16_t ReadAddress, uint8_t* ReadBuffer, uint16_t ReadSize)

-{

-	/* Wait until the NVM controller is no longer busy */

-	if (!(TINYNVM_WaitWhileNVMControllerBusy()))

-	  return false;

-

-	/* Set the NVM control register to the NO OP command for memory reading */

-	TINYNVM_SendWriteNVMRegister(XPROG_Param_NVMCMDRegAddr);

-	XPROGTarget_SendByte(TINY_NVM_CMD_NOOP);

-	

-	/* Send the address of the location to read from */

-	TINYNVM_SendPointerAddress(ReadAddress);

-	

-	while (ReadSize-- && TimeoutMSRemaining)

-	{

-		/* Read the byte of data from the target */

-		XPROGTarget_SendByte(TPI_CMD_SLD | TPI_POINTER_INDIRECT_PI);

-		*(ReadBuffer++) = XPROGTarget_ReceiveByte();

-	}

-	

-	return (TimeoutMSRemaining != 0);

-}

-

-/** Writes word addressed memory to the target's memory spaces.

- *

- *  \param[in] WriteAddress  Start address to write to within the target's address space

- *  \param[in] WriteBuffer   Buffer to source data from

- *  \param[in] WriteLength   Total number of bytes to write to the device (must be an integer multiple of 2)

- *

- *  \return Boolean true if the command sequence complete successfully

- */

-bool TINYNVM_WriteMemory(const uint16_t WriteAddress, uint8_t* WriteBuffer, uint16_t WriteLength)

-{

-	/* Wait until the NVM controller is no longer busy */

-	if (!(TINYNVM_WaitWhileNVMControllerBusy()))

-	  return false;

-	  

-	/* Must have an integer number of words to write - if extra byte, word-align via a dummy high byte */

-	if (WriteLength & 0x01)

-	  WriteBuffer[WriteLength++] = 0xFF;

-

-	/* Set the NVM control register to the WORD WRITE command for memory reading */

-	TINYNVM_SendWriteNVMRegister(XPROG_Param_NVMCMDRegAddr);

-	XPROGTarget_SendByte(TINY_NVM_CMD_WORDWRITE);

-	

-	/* Send the address of the location to write to */

-	TINYNVM_SendPointerAddress(WriteAddress);

-	

-	while (WriteLength)

-	{

-		/* Wait until the NVM controller is no longer busy */

-		if (!(TINYNVM_WaitWhileNVMControllerBusy()))

-		  return false;

-

-		/* Write the low byte of data to the target */

-		XPROGTarget_SendByte(TPI_CMD_SST | TPI_POINTER_INDIRECT_PI);

-		XPROGTarget_SendByte(*(WriteBuffer++));

-		

-		/* Write the high byte of data to the target */

-		XPROGTarget_SendByte(TPI_CMD_SST | TPI_POINTER_INDIRECT_PI);

-		XPROGTarget_SendByte(*(WriteBuffer++));

-

-		/* Need to decrement the write length twice, since we read out a whole word */

-		WriteLength -= 2;

-	}

-	

-	return true;

-}

-

-/** Erases the target's memory space.

- *

- *  \param[in] EraseCommand  NVM erase command to send to the device

- *  \param[in] Address       Address inside the memory space to erase

- *

- *  \return Boolean true if the command sequence complete successfully

- */

-bool TINYNVM_EraseMemory(const uint8_t EraseCommand, const uint16_t Address)

-{

-	/* Wait until the NVM controller is no longer busy */

-	if (!(TINYNVM_WaitWhileNVMControllerBusy()))

-	  return false;

-

-	/* Set the NVM control register to the target memory erase command */

-	TINYNVM_SendWriteNVMRegister(XPROG_Param_NVMCMDRegAddr);

-	XPROGTarget_SendByte(EraseCommand);

-

-	/* Write to a high byte location within the target address space to start the erase process */

-	TINYNVM_SendPointerAddress(Address | 0x0001);

-	XPROGTarget_SendByte(TPI_CMD_SST | TPI_POINTER_INDIRECT);

-	XPROGTarget_SendByte(0x00);

-

-	/* Wait until the NVM controller is no longer busy */

-	if (!(TINYNVM_WaitWhileNVMControllerBusy()))

-	  return false;

-	

-	return true;

-}

-

-#endif

+/*
+             LUFA Library
+     Copyright (C) Dean Camera, 2010.
+              
+  dean [at] fourwalledcubicle [dot] com
+      www.fourwalledcubicle.com
+*/
+
+/*
+  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)
+
+  Permission to use, copy, modify, distribute, and sell this 
+  software and its documentation for any purpose is hereby granted
+  without fee, provided that the above copyright notice appear in 
+  all copies and that both that the copyright notice and this
+  permission notice and warranty disclaimer appear in supporting 
+  documentation, and that the name of the author not be used in 
+  advertising or publicity pertaining to distribution of the 
+  software without specific, written prior permission.
+
+  The author disclaim all warranties with regard to this
+  software, including all implied warranties of merchantability
+  and fitness.  In no event shall the author be liable for any
+  special, indirect or consequential damages or any damages
+  whatsoever resulting from loss of use, data or profits, whether
+  in an action of contract, negligence or other tortious action,
+  arising out of or in connection with the use or performance of
+  this software.
+*/
+
+/** \file
+ *
+ *  Target-related functions for the TINY target's NVM module.
+ */
+
+#define  INCLUDE_FROM_TINYNVM_C
+#include "TINYNVM.h"
+
+#if defined(ENABLE_XPROG_PROTOCOL) || defined(__DOXYGEN__)
+
+/** Sends the given pointer address to the target's TPI pointer register */
+static void TINYNVM_SendPointerAddress(const uint16_t AbsoluteAddress)
+{
+	/* Send the given 16-bit address to the target, LSB first */
+	XPROGTarget_SendByte(TPI_CMD_SSTPR | 0);
+	XPROGTarget_SendByte(((uint8_t*)&AbsoluteAddress)[0]);
+	XPROGTarget_SendByte(TPI_CMD_SSTPR | 1);
+	XPROGTarget_SendByte(((uint8_t*)&AbsoluteAddress)[1]);
+}
+
+/** Sends a SIN command to the target with the specified I/O address, ready for the data byte to be written.
+ *
+ *  \param[in] Address  6-bit I/O address to write to in the target's I/O memory space
+ */
+static void TINYNVM_SendReadNVMRegister(const uint8_t Address)
+{
+	/* The TPI command for reading from the I/O space uses strange addressing, where the I/O address's upper
+	 * two bits of the 6-bit address are shifted left once */
+	XPROGTarget_SendByte(TPI_CMD_SIN | ((Address & 0x30) << 1) | (Address & 0x0F));
+}
+
+/** Sends a SOUT command to the target with the specified I/O address, ready for the data byte to be read.
+ *
+ *  \param[in] Address  6-bit I/O address to read from in the target's I/O memory space
+ */
+static void TINYNVM_SendWriteNVMRegister(const uint8_t Address)
+{
+	/* The TPI command for reading from the I/O space uses strange addressing, where the I/O address's upper
+	 * two bits of the 6-bit address are shifted left once */
+	XPROGTarget_SendByte(TPI_CMD_SOUT | ((Address & 0x30) << 1) | (Address & 0x0F));
+}
+
+/** Busy-waits while the NVM controller is busy performing a NVM operation, such as a FLASH page read.
+ *
+ *  \return Boolean true if the NVM controller became ready within the timeout period, false otherwise
+ */
+bool TINYNVM_WaitWhileNVMBusBusy(void)
+{
+	/* Poll the STATUS register to check to see if NVM access has been enabled */
+	while (TimeoutMSRemaining)
+	{
+		/* Send the SLDCS command to read the TPI STATUS register to see the NVM bus is active */
+		XPROGTarget_SendByte(TPI_CMD_SLDCS | TPI_STATUS_REG);
+
+		uint8_t StatusRegister = XPROGTarget_ReceiveByte();
+
+		/* We might have timed out waiting for the status register read response, check here */
+		if (!(TimeoutMSRemaining))
+		  return false;
+
+		/* Check the status register read response to see if the NVM bus is enabled */
+		if (StatusRegister & TPI_STATUS_NVM)
+		{
+			TimeoutMSRemaining = COMMAND_TIMEOUT_MS;
+			return true;
+		}
+	}
+
+	return false;
+}
+
+/** Waits while the target's NVM controller is busy performing an operation, exiting if the
+ *  timeout period expires.
+ *
+ *  \return Boolean true if the NVM controller became ready within the timeout period, false otherwise
+ */
+bool TINYNVM_WaitWhileNVMControllerBusy(void)
+{
+	/* Poll the STATUS register to check to see if NVM access has been enabled */
+	while (TimeoutMSRemaining)
+	{
+		/* Send the SIN command to read the TPI STATUS register to see the NVM bus is busy */
+		TINYNVM_SendReadNVMRegister(XPROG_Param_NVMCSRRegAddr);
+
+		uint8_t StatusRegister = XPROGTarget_ReceiveByte();
+
+		/* We might have timed out waiting for the status register read response, check here */
+		if (!(TimeoutMSRemaining))
+		  return false;
+
+		/* Check to see if the BUSY flag is still set */
+		if (!(StatusRegister & (1 << 7)))
+		{
+			TimeoutMSRemaining = COMMAND_TIMEOUT_MS;
+			return true;
+		}
+	}
+
+	return false;
+}
+
+/** Reads memory from the target's memory spaces.
+ *
+ *  \param[in]  ReadAddress  Start address to read from within the target's address space
+ *  \param[out] ReadBuffer   Buffer to store read data into
+ *  \param[in]  ReadSize     Length of the data to read from the device
+ *
+ *  \return Boolean true if the command sequence complete successfully
+ */
+bool TINYNVM_ReadMemory(const uint16_t ReadAddress, uint8_t* ReadBuffer, uint16_t ReadSize)
+{
+	/* Wait until the NVM controller is no longer busy */
+	if (!(TINYNVM_WaitWhileNVMControllerBusy()))
+	  return false;
+
+	/* Set the NVM control register to the NO OP command for memory reading */
+	TINYNVM_SendWriteNVMRegister(XPROG_Param_NVMCMDRegAddr);
+	XPROGTarget_SendByte(TINY_NVM_CMD_NOOP);
+	
+	/* Send the address of the location to read from */
+	TINYNVM_SendPointerAddress(ReadAddress);
+	
+	while (ReadSize-- && TimeoutMSRemaining)
+	{
+		/* Read the byte of data from the target */
+		XPROGTarget_SendByte(TPI_CMD_SLD | TPI_POINTER_INDIRECT_PI);
+		*(ReadBuffer++) = XPROGTarget_ReceiveByte();
+	}
+	
+	return (TimeoutMSRemaining != 0);
+}
+
+/** Writes word addressed memory to the target's memory spaces.
+ *
+ *  \param[in] WriteAddress  Start address to write to within the target's address space
+ *  \param[in] WriteBuffer   Buffer to source data from
+ *  \param[in] WriteLength   Total number of bytes to write to the device (must be an integer multiple of 2)
+ *
+ *  \return Boolean true if the command sequence complete successfully
+ */
+bool TINYNVM_WriteMemory(const uint16_t WriteAddress, uint8_t* WriteBuffer, uint16_t WriteLength)
+{
+	/* Wait until the NVM controller is no longer busy */
+	if (!(TINYNVM_WaitWhileNVMControllerBusy()))
+	  return false;
+	  
+	/* Must have an integer number of words to write - if extra byte, word-align via a dummy high byte */
+	if (WriteLength & 0x01)
+	  WriteBuffer[WriteLength++] = 0xFF;
+
+	/* Set the NVM control register to the WORD WRITE command for memory reading */
+	TINYNVM_SendWriteNVMRegister(XPROG_Param_NVMCMDRegAddr);
+	XPROGTarget_SendByte(TINY_NVM_CMD_WORDWRITE);
+	
+	/* Send the address of the location to write to */
+	TINYNVM_SendPointerAddress(WriteAddress);
+	
+	while (WriteLength)
+	{
+		/* Wait until the NVM controller is no longer busy */
+		if (!(TINYNVM_WaitWhileNVMControllerBusy()))
+		  return false;
+
+		/* Write the low byte of data to the target */
+		XPROGTarget_SendByte(TPI_CMD_SST | TPI_POINTER_INDIRECT_PI);
+		XPROGTarget_SendByte(*(WriteBuffer++));
+		
+		/* Write the high byte of data to the target */
+		XPROGTarget_SendByte(TPI_CMD_SST | TPI_POINTER_INDIRECT_PI);
+		XPROGTarget_SendByte(*(WriteBuffer++));
+
+		/* Need to decrement the write length twice, since we read out a whole word */
+		WriteLength -= 2;
+	}
+	
+	return true;
+}
+
+/** Erases the target's memory space.
+ *
+ *  \param[in] EraseCommand  NVM erase command to send to the device
+ *  \param[in] Address       Address inside the memory space to erase
+ *
+ *  \return Boolean true if the command sequence complete successfully
+ */
+bool TINYNVM_EraseMemory(const uint8_t EraseCommand, const uint16_t Address)
+{
+	/* Wait until the NVM controller is no longer busy */
+	if (!(TINYNVM_WaitWhileNVMControllerBusy()))
+	  return false;
+
+	/* Set the NVM control register to the target memory erase command */
+	TINYNVM_SendWriteNVMRegister(XPROG_Param_NVMCMDRegAddr);
+	XPROGTarget_SendByte(EraseCommand);
+
+	/* Write to a high byte location within the target address space to start the erase process */
+	TINYNVM_SendPointerAddress(Address | 0x0001);
+	XPROGTarget_SendByte(TPI_CMD_SST | TPI_POINTER_INDIRECT);
+	XPROGTarget_SendByte(0x00);
+
+	/* Wait until the NVM controller is no longer busy */
+	if (!(TINYNVM_WaitWhileNVMControllerBusy()))
+	  return false;
+	
+	return true;
+}
+
+#endif
diff --git a/Projects/AVRISP-MKII/Lib/XPROG/TINYNVM.h b/Projects/AVRISP-MKII/Lib/XPROG/TINYNVM.h
index 223bbccfd..73bf1f953 100644
--- a/Projects/AVRISP-MKII/Lib/XPROG/TINYNVM.h
+++ b/Projects/AVRISP-MKII/Lib/XPROG/TINYNVM.h
@@ -1,77 +1,77 @@
-/*

-             LUFA Library

-     Copyright (C) Dean Camera, 2010.

-              

-  dean [at] fourwalledcubicle [dot] com

-      www.fourwalledcubicle.com

-*/

-

-/*

-  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)

-

-  Permission to use, copy, modify, distribute, and sell this 

-  software and its documentation for any purpose is hereby granted

-  without fee, provided that the above copyright notice appear in 

-  all copies and that both that the copyright notice and this

-  permission notice and warranty disclaimer appear in supporting 

-  documentation, and that the name of the author not be used in 

-  advertising or publicity pertaining to distribution of the 

-  software without specific, written prior permission.

-

-  The author disclaim all warranties with regard to this

-  software, including all implied warranties of merchantability

-  and fitness.  In no event shall the author be liable for any

-  special, indirect or consequential damages or any damages

-  whatsoever resulting from loss of use, data or profits, whether

-  in an action of contract, negligence or other tortious action,

-  arising out of or in connection with the use or performance of

-  this software.

-*/

-

-/** \file

- *

- *  Header file for TINYNVM.c.

- */

-

-#ifndef _TINY_NVM_

-#define _TINY_NVM_

-

-	/* Includes: */

-		#include <avr/io.h>

-		#include <avr/interrupt.h>

-		#include <stdbool.h>

-		

-		#include <LUFA/Common/Common.h>

-		

-		#include "XPROGProtocol.h"

-		#include "XPROGTarget.h"

-	

-	/* Preprocessor Checks: */

-		#if ((BOARD == BOARD_XPLAIN) || (BOARD == BOARD_XPLAIN_REV1))

-			#undef ENABLE_ISP_PROTOCOL

-			

-			#if !defined(ENABLE_XPROG_PROTOCOL)

-				#define ENABLE_XPROG_PROTOCOL

-			#endif

-		#endif

-

-	/* Defines: */

-		#define TINY_NVM_CMD_NOOP              0x00

-		#define TINY_NVM_CMD_CHIPERASE         0x10

-		#define TINY_NVM_CMD_SECTIONERASE      0x14

-		#define TINY_NVM_CMD_WORDWRITE         0x1D

-

-	/* Function Prototypes: */		

-		bool TINYNVM_WaitWhileNVMBusBusy(void);

-		bool TINYNVM_WaitWhileNVMControllerBusy(void);

-		bool TINYNVM_ReadMemory(const uint16_t ReadAddress, uint8_t* ReadBuffer, uint16_t ReadLength);

-		bool TINYNVM_WriteMemory(const uint16_t WriteAddress, uint8_t* WriteBuffer, uint16_t WriteLength);

-		bool TINYNVM_EraseMemory(const uint8_t EraseCommand, const uint16_t Address);

-

-		#if defined(INCLUDE_FROM_TINYNVM_C)

-			static void TINYNVM_SendReadNVMRegister(const uint8_t Address);

-			static void TINYNVM_SendWriteNVMRegister(const uint8_t Address);

-			static void TINYNVM_SendPointerAddress(const uint16_t AbsoluteAddress);

-		#endif

-

-#endif

+/*
+             LUFA Library
+     Copyright (C) Dean Camera, 2010.
+              
+  dean [at] fourwalledcubicle [dot] com
+      www.fourwalledcubicle.com
+*/
+
+/*
+  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)
+
+  Permission to use, copy, modify, distribute, and sell this 
+  software and its documentation for any purpose is hereby granted
+  without fee, provided that the above copyright notice appear in 
+  all copies and that both that the copyright notice and this
+  permission notice and warranty disclaimer appear in supporting 
+  documentation, and that the name of the author not be used in 
+  advertising or publicity pertaining to distribution of the 
+  software without specific, written prior permission.
+
+  The author disclaim all warranties with regard to this
+  software, including all implied warranties of merchantability
+  and fitness.  In no event shall the author be liable for any
+  special, indirect or consequential damages or any damages
+  whatsoever resulting from loss of use, data or profits, whether
+  in an action of contract, negligence or other tortious action,
+  arising out of or in connection with the use or performance of
+  this software.
+*/
+
+/** \file
+ *
+ *  Header file for TINYNVM.c.
+ */
+
+#ifndef _TINY_NVM_
+#define _TINY_NVM_
+
+	/* Includes: */
+		#include <avr/io.h>
+		#include <avr/interrupt.h>
+		#include <stdbool.h>
+		
+		#include <LUFA/Common/Common.h>
+		
+		#include "XPROGProtocol.h"
+		#include "XPROGTarget.h"
+	
+	/* Preprocessor Checks: */
+		#if ((BOARD == BOARD_XPLAIN) || (BOARD == BOARD_XPLAIN_REV1))
+			#undef ENABLE_ISP_PROTOCOL
+			
+			#if !defined(ENABLE_XPROG_PROTOCOL)
+				#define ENABLE_XPROG_PROTOCOL
+			#endif
+		#endif
+
+	/* Defines: */
+		#define TINY_NVM_CMD_NOOP              0x00
+		#define TINY_NVM_CMD_CHIPERASE         0x10
+		#define TINY_NVM_CMD_SECTIONERASE      0x14
+		#define TINY_NVM_CMD_WORDWRITE         0x1D
+
+	/* Function Prototypes: */		
+		bool TINYNVM_WaitWhileNVMBusBusy(void);
+		bool TINYNVM_WaitWhileNVMControllerBusy(void);
+		bool TINYNVM_ReadMemory(const uint16_t ReadAddress, uint8_t* ReadBuffer, uint16_t ReadLength);
+		bool TINYNVM_WriteMemory(const uint16_t WriteAddress, uint8_t* WriteBuffer, uint16_t WriteLength);
+		bool TINYNVM_EraseMemory(const uint8_t EraseCommand, const uint16_t Address);
+
+		#if defined(INCLUDE_FROM_TINYNVM_C)
+			static void TINYNVM_SendReadNVMRegister(const uint8_t Address);
+			static void TINYNVM_SendWriteNVMRegister(const uint8_t Address);
+			static void TINYNVM_SendPointerAddress(const uint16_t AbsoluteAddress);
+		#endif
+
+#endif
diff --git a/Projects/AVRISP-MKII/Lib/XPROG/XMEGANVM.c b/Projects/AVRISP-MKII/Lib/XPROG/XMEGANVM.c
index 1671d29ba..14ad97c74 100644
--- a/Projects/AVRISP-MKII/Lib/XPROG/XMEGANVM.c
+++ b/Projects/AVRISP-MKII/Lib/XPROG/XMEGANVM.c
@@ -1,356 +1,356 @@
-/*

-             LUFA Library

-     Copyright (C) Dean Camera, 2010.

-              

-  dean [at] fourwalledcubicle [dot] com

-      www.fourwalledcubicle.com

-*/

-

-/*

-  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)

-

-  Permission to use, copy, modify, distribute, and sell this 

-  software and its documentation for any purpose is hereby granted

-  without fee, provided that the above copyright notice appear in 

-  all copies and that both that the copyright notice and this

-  permission notice and warranty disclaimer appear in supporting 

-  documentation, and that the name of the author not be used in 

-  advertising or publicity pertaining to distribution of the 

-  software without specific, written prior permission.

-

-  The author disclaim all warranties with regard to this

-  software, including all implied warranties of merchantability

-  and fitness.  In no event shall the author be liable for any

-  special, indirect or consequential damages or any damages

-  whatsoever resulting from loss of use, data or profits, whether

-  in an action of contract, negligence or other tortious action,

-  arising out of or in connection with the use or performance of

-  this software.

-*/

-

-/** \file

- *

- *  Target-related functions for the XMEGA target's NVM module.

- */

-

-#define  INCLUDE_FROM_XMEGA_NVM_C

-#include "XMEGANVM.h"

-

-#if defined(ENABLE_XPROG_PROTOCOL) || defined(__DOXYGEN__)

-

-/** Sends the given 32-bit absolute address to the target.

- *

- *  \param[in] AbsoluteAddress  Absolute address to send to the target

- */

-static void XMEGANVM_SendAddress(const uint32_t AbsoluteAddress)

-{

-	/* Send the given 32-bit address to the target, LSB first */

-	XPROGTarget_SendByte(((uint8_t*)&AbsoluteAddress)[0]);

-	XPROGTarget_SendByte(((uint8_t*)&AbsoluteAddress)[1]);

-	XPROGTarget_SendByte(((uint8_t*)&AbsoluteAddress)[2]);

-	XPROGTarget_SendByte(((uint8_t*)&AbsoluteAddress)[3]);

-}

-

-/** Sends the given NVM register address to the target.

- *

- *  \param[in] Register  NVM register whose absolute address is to be sent

- */

-static void XMEGANVM_SendNVMRegAddress(const uint8_t Register)

-{

-	/* Determine the absolute register address from the NVM base memory address and the NVM register address */

-	uint32_t Address = XPROG_Param_NVMBase | Register;

-

-	/* Send the calculated 32-bit address to the target, LSB first */

-	XMEGANVM_SendAddress(Address);

-}

-

-/** Busy-waits while the NVM controller is busy performing a NVM operation, such as a FLASH page read or CRC

- *  calculation.

- *

- *  \return Boolean true if the NVM controller became ready within the timeout period, false otherwise

- */

-bool XMEGANVM_WaitWhileNVMBusBusy(void)

-{

-	/* Poll the STATUS register to check to see if NVM access has been enabled */

-	while (TimeoutMSRemaining)

-	{

-		/* Send the LDCS command to read the PDI STATUS register to see the NVM bus is active */

-		XPROGTarget_SendByte(PDI_CMD_LDCS | PDI_STATUS_REG);

-		

-		uint8_t StatusRegister = XPROGTarget_ReceiveByte();

-		

-		/* We might have timed out waiting for the status register read response, check here */

-		if (!(TimeoutMSRemaining))

-		  return false;

-		

-		/* Check the status register read response to see if the NVM bus is enabled */

-		if (StatusRegister & PDI_STATUS_NVM)

-		{

-			TimeoutMSRemaining = COMMAND_TIMEOUT_MS;

-			return true;

-		}

-	}

-	

-	return false;

-}

-

-/** Waits while the target's NVM controller is busy performing an operation, exiting if the

- *  timeout period expires.

- *

- *  \return Boolean true if the NVM controller became ready within the timeout period, false otherwise

- */

-bool XMEGANVM_WaitWhileNVMControllerBusy(void)

-{

-	/* Poll the NVM STATUS register while the NVM controller is busy */

-	while (TimeoutMSRemaining)

-	{

-		/* Send a LDS command to read the NVM STATUS register to check the BUSY flag */

-		XPROGTarget_SendByte(PDI_CMD_LDS | (PDI_DATSIZE_4BYTES << 2));

-		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_STATUS);

-		

-		uint8_t StatusRegister = XPROGTarget_ReceiveByte();

-

-		/* We might have timed out waiting for the status register read response, check here */

-		if (!(TimeoutMSRemaining))

-		  return false;

-

-		/* Check to see if the BUSY flag is still set */

-		if (!(StatusRegister & (1 << 7)))

-		{

-			TimeoutMSRemaining = COMMAND_TIMEOUT_MS;

-			return true;

-		}

-	}

-	

-	return false;

-}

-

-/** Retrieves the CRC value of the given memory space.

- *

- *  \param[in]  CRCCommand  NVM CRC command to issue to the target

- *  \param[out] CRCDest     CRC Destination when read from the target

- *

- *  \return Boolean true if the command sequence complete successfully

- */

-bool XMEGANVM_GetMemoryCRC(const uint8_t CRCCommand, uint32_t* const CRCDest)

-{

-	/* Wait until the NVM controller is no longer busy */

-	if (!(XMEGANVM_WaitWhileNVMControllerBusy()))

-	  return false;

-	  

-	/* Set the NVM command to the correct CRC read command */

-	XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));

-	XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);

-	XPROGTarget_SendByte(CRCCommand);

-

-	/* Set CMDEX bit in NVM CTRLA register to start the CRC generation */

-	XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));

-	XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CTRLA);

-	XPROGTarget_SendByte(1 << 0);

-

-	/* Wait until the NVM bus is ready again */

-	if (!(XMEGANVM_WaitWhileNVMBusBusy()))

-	  return false;

-

-	/* Wait until the NVM controller is no longer busy */

-	if (!(XMEGANVM_WaitWhileNVMControllerBusy()))

-	  return false;

-	

-	/* Load the PDI pointer register with the DAT0 register start address */

-	XPROGTarget_SendByte(PDI_CMD_ST | (PDI_POINTER_DIRECT << 2) | PDI_DATSIZE_4BYTES);

-	XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_DAT0);

-

-	/* Send the REPEAT command to grab the CRC bytes */

-	XPROGTarget_SendByte(PDI_CMD_REPEAT | PDI_DATSIZE_1BYTE);

-	XPROGTarget_SendByte(XMEGA_CRC_LENGTH - 1);

-	

-	/* Read in the CRC bytes from the target */

-	XPROGTarget_SendByte(PDI_CMD_LD | (PDI_POINTER_INDIRECT_PI << 2) | PDI_DATSIZE_1BYTE);

-	for (uint8_t i = 0; i < XMEGA_CRC_LENGTH; i++)

-	  ((uint8_t*)CRCDest)[i] = XPROGTarget_ReceiveByte();

-	

-	return (TimeoutMSRemaining != 0);

-}

-

-/** Reads memory from the target's memory spaces.

- *

- *  \param[in]  ReadAddress  Start address to read from within the target's address space

- *  \param[out] ReadBuffer   Buffer to store read data into

- *  \param[in]  ReadSize     Number of bytes to read

- *

- *  \return Boolean true if the command sequence complete successfully

- */

-bool XMEGANVM_ReadMemory(const uint32_t ReadAddress, uint8_t* ReadBuffer, uint16_t ReadSize)

-{

-	/* Wait until the NVM controller is no longer busy */

-	if (!(XMEGANVM_WaitWhileNVMControllerBusy()))

-	  return false;

-	

-	/* Send the READNVM command to the NVM controller for reading of an arbitrary location */

-	XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));

-	XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);

-	XPROGTarget_SendByte(XMEGA_NVM_CMD_READNVM);

-

-	/* Load the PDI pointer register with the start address we want to read from */

-	XPROGTarget_SendByte(PDI_CMD_ST | (PDI_POINTER_DIRECT << 2) | PDI_DATSIZE_4BYTES);

-	XMEGANVM_SendAddress(ReadAddress);

-

-	/* Send the REPEAT command with the specified number of bytes to read */

-	XPROGTarget_SendByte(PDI_CMD_REPEAT | PDI_DATSIZE_1BYTE);

-	XPROGTarget_SendByte(ReadSize - 1);

-		

-	/* Send a LD command with indirect access and postincrement to read out the bytes */

-	XPROGTarget_SendByte(PDI_CMD_LD | (PDI_POINTER_INDIRECT_PI << 2) | PDI_DATSIZE_1BYTE);

-	while (ReadSize-- && TimeoutMSRemaining)

-	  *(ReadBuffer++) = XPROGTarget_ReceiveByte();

-	

-	return (TimeoutMSRemaining != 0);

-}

-

-/** Writes byte addressed memory to the target's memory spaces.

- *

- *  \param[in]  WriteCommand  Command to send to the device to write each memory byte

- *  \param[in]  WriteAddress  Address to write to within the target's address space

- *  \param[in]  Byte          Byte to write to the target

- *

- *  \return Boolean true if the command sequence complete successfully

- */

-bool XMEGANVM_WriteByteMemory(const uint8_t WriteCommand, const uint32_t WriteAddress, const uint8_t Byte)

-{

-	/* Wait until the NVM controller is no longer busy */

-	if (!(XMEGANVM_WaitWhileNVMControllerBusy()))

-	  return false;

-

-	/* Send the memory write command to the target */

-	XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));

-	XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);

-	XPROGTarget_SendByte(WriteCommand);

-	

-	/* Send new memory byte to the memory to the target */

-	XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));

-	XMEGANVM_SendAddress(WriteAddress);

-	XPROGTarget_SendByte(Byte);

-	

-	return true;

-}

-

-/** Writes page addressed memory to the target's memory spaces.

- *

- *  \param[in]  WriteBuffCommand  Command to send to the device to write a byte to the memory page buffer

- *  \param[in]  EraseBuffCommand  Command to send to the device to erase the memory page buffer

- *  \param[in]  WritePageCommand  Command to send to the device to write the page buffer to the destination memory

- *  \param[in]  PageMode          Bitfield indicating what operations need to be executed on the specified page

- *  \param[in]  WriteAddress      Start address to write the page data to within the target's address space

- *  \param[in]  WriteBuffer       Buffer to source data from

- *  \param[in]  WriteSize         Number of bytes to write

- *

- *  \return Boolean true if the command sequence complete successfully

- */

-bool XMEGANVM_WritePageMemory(const uint8_t WriteBuffCommand, const uint8_t EraseBuffCommand,

-                              const uint8_t WritePageCommand, const uint8_t PageMode, const uint32_t WriteAddress,

-                              const uint8_t* WriteBuffer, uint16_t WriteSize)

-{

-	if (PageMode & XPRG_PAGEMODE_ERASE)

-	{

-		/* Wait until the NVM controller is no longer busy */

-		if (!(XMEGANVM_WaitWhileNVMControllerBusy()))

-		  return false;

-

-		/* Send the memory buffer erase command to the target */

-		XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));

-		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);

-		XPROGTarget_SendByte(EraseBuffCommand);

-

-		/* Set CMDEX bit in NVM CTRLA register to start the buffer erase */

-		XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));

-		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CTRLA);

-		XPROGTarget_SendByte(1 << 0);

-	}

-

-	if (WriteSize)

-	{

-		/* Wait until the NVM controller is no longer busy */

-		if (!(XMEGANVM_WaitWhileNVMControllerBusy()))

-		  return false;

-

-		/* Send the memory buffer write command to the target */

-		XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));

-		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);

-		XPROGTarget_SendByte(WriteBuffCommand);

-

-		/* Load the PDI pointer register with the start address we want to write to */

-		XPROGTarget_SendByte(PDI_CMD_ST | (PDI_POINTER_DIRECT << 2) | PDI_DATSIZE_4BYTES);

-		XMEGANVM_SendAddress(WriteAddress);

-

-		/* Send the REPEAT command with the specified number of bytes to write */

-		XPROGTarget_SendByte(PDI_CMD_REPEAT | PDI_DATSIZE_1BYTE);

-		XPROGTarget_SendByte(WriteSize - 1);

-			

-		/* Send a ST command with indirect access and postincrement to write the bytes */

-		XPROGTarget_SendByte(PDI_CMD_ST | (PDI_POINTER_INDIRECT_PI << 2) | PDI_DATSIZE_1BYTE);

-		while (WriteSize--)

-		  XPROGTarget_SendByte(*(WriteBuffer++));

-	}

-	

-	if (PageMode & XPRG_PAGEMODE_WRITE)

-	{

-		/* Wait until the NVM controller is no longer busy */

-		if (!(XMEGANVM_WaitWhileNVMControllerBusy()))

-		  return false;

-

-		/* Send the memory write command to the target */

-		XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));

-		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);

-		XPROGTarget_SendByte(WritePageCommand);

-		

-		/* Send the address of the first page location to write the memory page */

-		XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));

-		XMEGANVM_SendAddress(WriteAddress);

-		XPROGTarget_SendByte(0x00);

-	}

-

-	return true;

-}

-

-/** Erases a specific memory space of the target.

- *

- *  \param[in] EraseCommand  NVM erase command to send to the device

- *  \param[in] Address  Address inside the memory space to erase

- *

- *  \return Boolean true if the command sequence complete successfully

- */

-bool XMEGANVM_EraseMemory(const uint8_t EraseCommand, const uint32_t Address)

-{

-	/* Wait until the NVM controller is no longer busy */

-	if (!(XMEGANVM_WaitWhileNVMControllerBusy()))

-	  return false;

-	  

-	/* Send the memory erase command to the target */

-	XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));

-	XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);

-	XPROGTarget_SendByte(EraseCommand);

-	

-	/* Chip erase is handled separately, since it's procedure is different to other erase types */

-	if (EraseCommand == XMEGA_NVM_CMD_CHIPERASE)

-	{

-		/* Set CMDEX bit in NVM CTRLA register to start the chip erase */

-		XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));

-		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CTRLA);

-		XPROGTarget_SendByte(1 << 0);		

-	}

-	else

-	{

-		/* Other erase modes just need us to address a byte within the target memory space */

-		XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));

-		XMEGANVM_SendAddress(Address);

-		XPROGTarget_SendByte(0x00);

-	}

-	

-	/* Wait until the NVM bus is ready again */

-	if (!(XMEGANVM_WaitWhileNVMBusBusy()))

-	  return false;

-	  

-	return true;

-}

-

-#endif

+/*
+             LUFA Library
+     Copyright (C) Dean Camera, 2010.
+              
+  dean [at] fourwalledcubicle [dot] com
+      www.fourwalledcubicle.com
+*/
+
+/*
+  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)
+
+  Permission to use, copy, modify, distribute, and sell this 
+  software and its documentation for any purpose is hereby granted
+  without fee, provided that the above copyright notice appear in 
+  all copies and that both that the copyright notice and this
+  permission notice and warranty disclaimer appear in supporting 
+  documentation, and that the name of the author not be used in 
+  advertising or publicity pertaining to distribution of the 
+  software without specific, written prior permission.
+
+  The author disclaim all warranties with regard to this
+  software, including all implied warranties of merchantability
+  and fitness.  In no event shall the author be liable for any
+  special, indirect or consequential damages or any damages
+  whatsoever resulting from loss of use, data or profits, whether
+  in an action of contract, negligence or other tortious action,
+  arising out of or in connection with the use or performance of
+  this software.
+*/
+
+/** \file
+ *
+ *  Target-related functions for the XMEGA target's NVM module.
+ */
+
+#define  INCLUDE_FROM_XMEGA_NVM_C
+#include "XMEGANVM.h"
+
+#if defined(ENABLE_XPROG_PROTOCOL) || defined(__DOXYGEN__)
+
+/** Sends the given 32-bit absolute address to the target.
+ *
+ *  \param[in] AbsoluteAddress  Absolute address to send to the target
+ */
+static void XMEGANVM_SendAddress(const uint32_t AbsoluteAddress)
+{
+	/* Send the given 32-bit address to the target, LSB first */
+	XPROGTarget_SendByte(((uint8_t*)&AbsoluteAddress)[0]);
+	XPROGTarget_SendByte(((uint8_t*)&AbsoluteAddress)[1]);
+	XPROGTarget_SendByte(((uint8_t*)&AbsoluteAddress)[2]);
+	XPROGTarget_SendByte(((uint8_t*)&AbsoluteAddress)[3]);
+}
+
+/** Sends the given NVM register address to the target.
+ *
+ *  \param[in] Register  NVM register whose absolute address is to be sent
+ */
+static void XMEGANVM_SendNVMRegAddress(const uint8_t Register)
+{
+	/* Determine the absolute register address from the NVM base memory address and the NVM register address */
+	uint32_t Address = XPROG_Param_NVMBase | Register;
+
+	/* Send the calculated 32-bit address to the target, LSB first */
+	XMEGANVM_SendAddress(Address);
+}
+
+/** Busy-waits while the NVM controller is busy performing a NVM operation, such as a FLASH page read or CRC
+ *  calculation.
+ *
+ *  \return Boolean true if the NVM controller became ready within the timeout period, false otherwise
+ */
+bool XMEGANVM_WaitWhileNVMBusBusy(void)
+{
+	/* Poll the STATUS register to check to see if NVM access has been enabled */
+	while (TimeoutMSRemaining)
+	{
+		/* Send the LDCS command to read the PDI STATUS register to see the NVM bus is active */
+		XPROGTarget_SendByte(PDI_CMD_LDCS | PDI_STATUS_REG);
+		
+		uint8_t StatusRegister = XPROGTarget_ReceiveByte();
+		
+		/* We might have timed out waiting for the status register read response, check here */
+		if (!(TimeoutMSRemaining))
+		  return false;
+		
+		/* Check the status register read response to see if the NVM bus is enabled */
+		if (StatusRegister & PDI_STATUS_NVM)
+		{
+			TimeoutMSRemaining = COMMAND_TIMEOUT_MS;
+			return true;
+		}
+	}
+	
+	return false;
+}
+
+/** Waits while the target's NVM controller is busy performing an operation, exiting if the
+ *  timeout period expires.
+ *
+ *  \return Boolean true if the NVM controller became ready within the timeout period, false otherwise
+ */
+bool XMEGANVM_WaitWhileNVMControllerBusy(void)
+{
+	/* Poll the NVM STATUS register while the NVM controller is busy */
+	while (TimeoutMSRemaining)
+	{
+		/* Send a LDS command to read the NVM STATUS register to check the BUSY flag */
+		XPROGTarget_SendByte(PDI_CMD_LDS | (PDI_DATSIZE_4BYTES << 2));
+		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_STATUS);
+		
+		uint8_t StatusRegister = XPROGTarget_ReceiveByte();
+
+		/* We might have timed out waiting for the status register read response, check here */
+		if (!(TimeoutMSRemaining))
+		  return false;
+
+		/* Check to see if the BUSY flag is still set */
+		if (!(StatusRegister & (1 << 7)))
+		{
+			TimeoutMSRemaining = COMMAND_TIMEOUT_MS;
+			return true;
+		}
+	}
+	
+	return false;
+}
+
+/** Retrieves the CRC value of the given memory space.
+ *
+ *  \param[in]  CRCCommand  NVM CRC command to issue to the target
+ *  \param[out] CRCDest     CRC Destination when read from the target
+ *
+ *  \return Boolean true if the command sequence complete successfully
+ */
+bool XMEGANVM_GetMemoryCRC(const uint8_t CRCCommand, uint32_t* const CRCDest)
+{
+	/* Wait until the NVM controller is no longer busy */
+	if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
+	  return false;
+	  
+	/* Set the NVM command to the correct CRC read command */
+	XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));
+	XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
+	XPROGTarget_SendByte(CRCCommand);
+
+	/* Set CMDEX bit in NVM CTRLA register to start the CRC generation */
+	XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));
+	XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CTRLA);
+	XPROGTarget_SendByte(1 << 0);
+
+	/* Wait until the NVM bus is ready again */
+	if (!(XMEGANVM_WaitWhileNVMBusBusy()))
+	  return false;
+
+	/* Wait until the NVM controller is no longer busy */
+	if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
+	  return false;
+	
+	/* Load the PDI pointer register with the DAT0 register start address */
+	XPROGTarget_SendByte(PDI_CMD_ST | (PDI_POINTER_DIRECT << 2) | PDI_DATSIZE_4BYTES);
+	XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_DAT0);
+
+	/* Send the REPEAT command to grab the CRC bytes */
+	XPROGTarget_SendByte(PDI_CMD_REPEAT | PDI_DATSIZE_1BYTE);
+	XPROGTarget_SendByte(XMEGA_CRC_LENGTH - 1);
+	
+	/* Read in the CRC bytes from the target */
+	XPROGTarget_SendByte(PDI_CMD_LD | (PDI_POINTER_INDIRECT_PI << 2) | PDI_DATSIZE_1BYTE);
+	for (uint8_t i = 0; i < XMEGA_CRC_LENGTH; i++)
+	  ((uint8_t*)CRCDest)[i] = XPROGTarget_ReceiveByte();
+	
+	return (TimeoutMSRemaining != 0);
+}
+
+/** Reads memory from the target's memory spaces.
+ *
+ *  \param[in]  ReadAddress  Start address to read from within the target's address space
+ *  \param[out] ReadBuffer   Buffer to store read data into
+ *  \param[in]  ReadSize     Number of bytes to read
+ *
+ *  \return Boolean true if the command sequence complete successfully
+ */
+bool XMEGANVM_ReadMemory(const uint32_t ReadAddress, uint8_t* ReadBuffer, uint16_t ReadSize)
+{
+	/* Wait until the NVM controller is no longer busy */
+	if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
+	  return false;
+	
+	/* Send the READNVM command to the NVM controller for reading of an arbitrary location */
+	XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));
+	XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
+	XPROGTarget_SendByte(XMEGA_NVM_CMD_READNVM);
+
+	/* Load the PDI pointer register with the start address we want to read from */
+	XPROGTarget_SendByte(PDI_CMD_ST | (PDI_POINTER_DIRECT << 2) | PDI_DATSIZE_4BYTES);
+	XMEGANVM_SendAddress(ReadAddress);
+
+	/* Send the REPEAT command with the specified number of bytes to read */
+	XPROGTarget_SendByte(PDI_CMD_REPEAT | PDI_DATSIZE_1BYTE);
+	XPROGTarget_SendByte(ReadSize - 1);
+		
+	/* Send a LD command with indirect access and postincrement to read out the bytes */
+	XPROGTarget_SendByte(PDI_CMD_LD | (PDI_POINTER_INDIRECT_PI << 2) | PDI_DATSIZE_1BYTE);
+	while (ReadSize-- && TimeoutMSRemaining)
+	  *(ReadBuffer++) = XPROGTarget_ReceiveByte();
+	
+	return (TimeoutMSRemaining != 0);
+}
+
+/** Writes byte addressed memory to the target's memory spaces.
+ *
+ *  \param[in]  WriteCommand  Command to send to the device to write each memory byte
+ *  \param[in]  WriteAddress  Address to write to within the target's address space
+ *  \param[in]  Byte          Byte to write to the target
+ *
+ *  \return Boolean true if the command sequence complete successfully
+ */
+bool XMEGANVM_WriteByteMemory(const uint8_t WriteCommand, const uint32_t WriteAddress, const uint8_t Byte)
+{
+	/* Wait until the NVM controller is no longer busy */
+	if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
+	  return false;
+
+	/* Send the memory write command to the target */
+	XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));
+	XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
+	XPROGTarget_SendByte(WriteCommand);
+	
+	/* Send new memory byte to the memory to the target */
+	XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));
+	XMEGANVM_SendAddress(WriteAddress);
+	XPROGTarget_SendByte(Byte);
+	
+	return true;
+}
+
+/** Writes page addressed memory to the target's memory spaces.
+ *
+ *  \param[in]  WriteBuffCommand  Command to send to the device to write a byte to the memory page buffer
+ *  \param[in]  EraseBuffCommand  Command to send to the device to erase the memory page buffer
+ *  \param[in]  WritePageCommand  Command to send to the device to write the page buffer to the destination memory
+ *  \param[in]  PageMode          Bitfield indicating what operations need to be executed on the specified page
+ *  \param[in]  WriteAddress      Start address to write the page data to within the target's address space
+ *  \param[in]  WriteBuffer       Buffer to source data from
+ *  \param[in]  WriteSize         Number of bytes to write
+ *
+ *  \return Boolean true if the command sequence complete successfully
+ */
+bool XMEGANVM_WritePageMemory(const uint8_t WriteBuffCommand, const uint8_t EraseBuffCommand,
+                              const uint8_t WritePageCommand, const uint8_t PageMode, const uint32_t WriteAddress,
+                              const uint8_t* WriteBuffer, uint16_t WriteSize)
+{
+	if (PageMode & XPRG_PAGEMODE_ERASE)
+	{
+		/* Wait until the NVM controller is no longer busy */
+		if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
+		  return false;
+
+		/* Send the memory buffer erase command to the target */
+		XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));
+		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
+		XPROGTarget_SendByte(EraseBuffCommand);
+
+		/* Set CMDEX bit in NVM CTRLA register to start the buffer erase */
+		XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));
+		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CTRLA);
+		XPROGTarget_SendByte(1 << 0);
+	}
+
+	if (WriteSize)
+	{
+		/* Wait until the NVM controller is no longer busy */
+		if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
+		  return false;
+
+		/* Send the memory buffer write command to the target */
+		XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));
+		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
+		XPROGTarget_SendByte(WriteBuffCommand);
+
+		/* Load the PDI pointer register with the start address we want to write to */
+		XPROGTarget_SendByte(PDI_CMD_ST | (PDI_POINTER_DIRECT << 2) | PDI_DATSIZE_4BYTES);
+		XMEGANVM_SendAddress(WriteAddress);
+
+		/* Send the REPEAT command with the specified number of bytes to write */
+		XPROGTarget_SendByte(PDI_CMD_REPEAT | PDI_DATSIZE_1BYTE);
+		XPROGTarget_SendByte(WriteSize - 1);
+			
+		/* Send a ST command with indirect access and postincrement to write the bytes */
+		XPROGTarget_SendByte(PDI_CMD_ST | (PDI_POINTER_INDIRECT_PI << 2) | PDI_DATSIZE_1BYTE);
+		while (WriteSize--)
+		  XPROGTarget_SendByte(*(WriteBuffer++));
+	}
+	
+	if (PageMode & XPRG_PAGEMODE_WRITE)
+	{
+		/* Wait until the NVM controller is no longer busy */
+		if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
+		  return false;
+
+		/* Send the memory write command to the target */
+		XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));
+		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
+		XPROGTarget_SendByte(WritePageCommand);
+		
+		/* Send the address of the first page location to write the memory page */
+		XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));
+		XMEGANVM_SendAddress(WriteAddress);
+		XPROGTarget_SendByte(0x00);
+	}
+
+	return true;
+}
+
+/** Erases a specific memory space of the target.
+ *
+ *  \param[in] EraseCommand  NVM erase command to send to the device
+ *  \param[in] Address  Address inside the memory space to erase
+ *
+ *  \return Boolean true if the command sequence complete successfully
+ */
+bool XMEGANVM_EraseMemory(const uint8_t EraseCommand, const uint32_t Address)
+{
+	/* Wait until the NVM controller is no longer busy */
+	if (!(XMEGANVM_WaitWhileNVMControllerBusy()))
+	  return false;
+	  
+	/* Send the memory erase command to the target */
+	XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));
+	XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CMD);
+	XPROGTarget_SendByte(EraseCommand);
+	
+	/* Chip erase is handled separately, since it's procedure is different to other erase types */
+	if (EraseCommand == XMEGA_NVM_CMD_CHIPERASE)
+	{
+		/* Set CMDEX bit in NVM CTRLA register to start the chip erase */
+		XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));
+		XMEGANVM_SendNVMRegAddress(XMEGA_NVM_REG_CTRLA);
+		XPROGTarget_SendByte(1 << 0);		
+	}
+	else
+	{
+		/* Other erase modes just need us to address a byte within the target memory space */
+		XPROGTarget_SendByte(PDI_CMD_STS | (PDI_DATSIZE_4BYTES << 2));
+		XMEGANVM_SendAddress(Address);
+		XPROGTarget_SendByte(0x00);
+	}
+	
+	/* Wait until the NVM bus is ready again */
+	if (!(XMEGANVM_WaitWhileNVMBusBusy()))
+	  return false;
+	  
+	return true;
+}
+
+#endif
diff --git a/Projects/AVRISP-MKII/Lib/XPROG/XMEGANVM.h b/Projects/AVRISP-MKII/Lib/XPROG/XMEGANVM.h
index 583a2878b..af38afdac 100644
--- a/Projects/AVRISP-MKII/Lib/XPROG/XMEGANVM.h
+++ b/Projects/AVRISP-MKII/Lib/XPROG/XMEGANVM.h
@@ -1,124 +1,124 @@
-/*

-             LUFA Library

-     Copyright (C) Dean Camera, 2010.

-              

-  dean [at] fourwalledcubicle [dot] com

-      www.fourwalledcubicle.com

-*/

-

-/*

-  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)

-

-  Permission to use, copy, modify, distribute, and sell this 

-  software and its documentation for any purpose is hereby granted

-  without fee, provided that the above copyright notice appear in 

-  all copies and that both that the copyright notice and this

-  permission notice and warranty disclaimer appear in supporting 

-  documentation, and that the name of the author not be used in 

-  advertising or publicity pertaining to distribution of the 

-  software without specific, written prior permission.

-

-  The author disclaim all warranties with regard to this

-  software, including all implied warranties of merchantability

-  and fitness.  In no event shall the author be liable for any

-  special, indirect or consequential damages or any damages

-  whatsoever resulting from loss of use, data or profits, whether

-  in an action of contract, negligence or other tortious action,

-  arising out of or in connection with the use or performance of

-  this software.

-*/

-

-/** \file

- *

- *  Header file for XMEGANVM.c.

- */

-

-#ifndef _XMEGA_NVM_

-#define _XMEGA_NVM_

-

-	/* Includes: */

-		#include <avr/io.h>

-		#include <avr/interrupt.h>

-		#include <stdbool.h>

-		

-		#include <LUFA/Common/Common.h>

-		

-		#include "XPROGProtocol.h"

-		#include "XPROGTarget.h"

-	

-	/* Preprocessor Checks: */

-		#if ((BOARD == BOARD_XPLAIN) || (BOARD == BOARD_XPLAIN_REV1))

-			#undef ENABLE_ISP_PROTOCOL

-			

-			#if !defined(ENABLE_XPROG_PROTOCOL)

-				#define ENABLE_XPROG_PROTOCOL

-			#endif

-		#endif

-

-	/* Defines: */

-		#define XMEGA_CRC_LENGTH                     3

-	

-		#define XMEGA_NVM_REG_ADDR0                  0x00

-		#define XMEGA_NVM_REG_ADDR1                  0x01

-		#define XMEGA_NVM_REG_ADDR2                  0x02

-		#define XMEGA_NVM_REG_DAT0                   0x04

-		#define XMEGA_NVM_REG_DAT1                   0x05

-		#define XMEGA_NVM_REG_DAT2                   0x06

-		#define XMEGA_NVM_REG_CMD                    0x0A

-		#define XMEGA_NVM_REG_CTRLA                  0x0B

-		#define XMEGA_NVM_REG_CTRLB                  0x0C

-		#define XMEGA_NVM_REG_INTCTRL                0x0D

-		#define XMEGA_NVM_REG_STATUS                 0x0F

-		#define XMEGA_NVM_REG_LOCKBITS               0x10

-		

-		#define XMEGA_NVM_CMD_NOOP                   0x00

-		#define XMEGA_NVM_CMD_CHIPERASE              0x40

-		#define XMEGA_NVM_CMD_READNVM                0x43

-		#define XMEGA_NVM_CMD_LOADFLASHPAGEBUFF      0x23

-		#define XMEGA_NVM_CMD_ERASEFLASHPAGEBUFF     0x26

-		#define XMEGA_NVM_CMD_ERASEFLASHPAGE         0x2B

-		#define XMEGA_NVM_CMD_WRITEFLASHPAGE         0x2E

-		#define XMEGA_NVM_CMD_ERASEWRITEFLASH        0x2F

-		#define XMEGA_NVM_CMD_FLASHCRC               0x78

-		#define XMEGA_NVM_CMD_ERASEAPPSEC            0x20

-		#define XMEGA_NVM_CMD_ERASEAPPSECPAGE        0x22

-		#define XMEGA_NVM_CMD_WRITEAPPSECPAGE        0x24

-		#define XMEGA_NVM_CMD_ERASEWRITEAPPSECPAGE   0x25

-		#define XMEGA_NVM_CMD_APPCRC                 0x38

-		#define XMEGA_NVM_CMD_ERASEBOOTSEC           0x68

-		#define XMEGA_NVM_CMD_ERASEBOOTSECPAGE       0x2A

-		#define XMEGA_NVM_CMD_WRITEBOOTSECPAGE       0x2C

-		#define XMEGA_NVM_CMD_ERASEWRITEBOOTSECPAGE  0x2D

-		#define XMEGA_NVM_CMD_BOOTCRC                0x39

-		#define XMEGA_NVM_CMD_READUSERSIG            0x03

-		#define XMEGA_NVM_CMD_ERASEUSERSIG           0x18

-		#define XMEGA_NVM_CMD_WRITEUSERSIG           0x1A

-		#define XMEGA_NVM_CMD_READCALIBRATION        0x02

-		#define XMEGA_NVM_CMD_READFUSE               0x07

-		#define XMEGA_NVM_CMD_WRITEFUSE              0x4C

-		#define XMEGA_NVM_CMD_WRITELOCK              0x08

-		#define XMEGA_NVM_CMD_LOADEEPROMPAGEBUFF     0x33

-		#define XMEGA_NVM_CMD_ERASEEEPROMPAGEBUFF    0x36

-		#define XMEGA_NVM_CMD_ERASEEEPROM            0x30

-		#define XMEGA_NVM_CMD_ERASEEEPROMPAGE        0x32

-		#define XMEGA_NVM_CMD_WRITEEEPROMPAGE        0x34

-		#define XMEGA_NVM_CMD_ERASEWRITEEEPROMPAGE   0x35

-		#define XMEGA_NVM_CMD_READEEPROM             0x06

-

-	/* Function Prototypes: */

-		bool XMEGANVM_WaitWhileNVMBusBusy(void);

-		bool XMEGANVM_WaitWhileNVMControllerBusy(void);

-		bool XMEGANVM_GetMemoryCRC(const uint8_t CRCCommand, uint32_t* const CRCDest);

-		bool XMEGANVM_ReadMemory(const uint32_t ReadAddress, uint8_t* ReadBuffer, uint16_t ReadSize);

-		bool XMEGANVM_WriteByteMemory(const uint8_t WriteCommand, const uint32_t WriteAddress, const uint8_t Byte);

-		bool XMEGANVM_WritePageMemory(const uint8_t WriteBuffCommand, const uint8_t EraseBuffCommand,

-		                              const uint8_t WritePageCommand, const uint8_t PageMode, const uint32_t WriteAddress,

-		                              const uint8_t* WriteBuffer, uint16_t WriteSize);

-		bool XMEGANVM_EraseMemory(const uint8_t EraseCommand, const uint32_t Address);

-

-		#if defined(INCLUDE_FROM_XMEGANVM_C)

-			static void XMEGANVM_SendNVMRegAddress(const uint8_t Register);

-			static void XMEGANVM_SendAddress(const uint32_t AbsoluteAddress);		

-		#endif

-

-#endif

+/*
+             LUFA Library
+     Copyright (C) Dean Camera, 2010.
+              
+  dean [at] fourwalledcubicle [dot] com
+      www.fourwalledcubicle.com
+*/
+
+/*
+  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)
+
+  Permission to use, copy, modify, distribute, and sell this 
+  software and its documentation for any purpose is hereby granted
+  without fee, provided that the above copyright notice appear in 
+  all copies and that both that the copyright notice and this
+  permission notice and warranty disclaimer appear in supporting 
+  documentation, and that the name of the author not be used in 
+  advertising or publicity pertaining to distribution of the 
+  software without specific, written prior permission.
+
+  The author disclaim all warranties with regard to this
+  software, including all implied warranties of merchantability
+  and fitness.  In no event shall the author be liable for any
+  special, indirect or consequential damages or any damages
+  whatsoever resulting from loss of use, data or profits, whether
+  in an action of contract, negligence or other tortious action,
+  arising out of or in connection with the use or performance of
+  this software.
+*/
+
+/** \file
+ *
+ *  Header file for XMEGANVM.c.
+ */
+
+#ifndef _XMEGA_NVM_
+#define _XMEGA_NVM_
+
+	/* Includes: */
+		#include <avr/io.h>
+		#include <avr/interrupt.h>
+		#include <stdbool.h>
+		
+		#include <LUFA/Common/Common.h>
+		
+		#include "XPROGProtocol.h"
+		#include "XPROGTarget.h"
+	
+	/* Preprocessor Checks: */
+		#if ((BOARD == BOARD_XPLAIN) || (BOARD == BOARD_XPLAIN_REV1))
+			#undef ENABLE_ISP_PROTOCOL
+			
+			#if !defined(ENABLE_XPROG_PROTOCOL)
+				#define ENABLE_XPROG_PROTOCOL
+			#endif
+		#endif
+
+	/* Defines: */
+		#define XMEGA_CRC_LENGTH                     3
+	
+		#define XMEGA_NVM_REG_ADDR0                  0x00
+		#define XMEGA_NVM_REG_ADDR1                  0x01
+		#define XMEGA_NVM_REG_ADDR2                  0x02
+		#define XMEGA_NVM_REG_DAT0                   0x04
+		#define XMEGA_NVM_REG_DAT1                   0x05
+		#define XMEGA_NVM_REG_DAT2                   0x06
+		#define XMEGA_NVM_REG_CMD                    0x0A
+		#define XMEGA_NVM_REG_CTRLA                  0x0B
+		#define XMEGA_NVM_REG_CTRLB                  0x0C
+		#define XMEGA_NVM_REG_INTCTRL                0x0D
+		#define XMEGA_NVM_REG_STATUS                 0x0F
+		#define XMEGA_NVM_REG_LOCKBITS               0x10
+		
+		#define XMEGA_NVM_CMD_NOOP                   0x00
+		#define XMEGA_NVM_CMD_CHIPERASE              0x40
+		#define XMEGA_NVM_CMD_READNVM                0x43
+		#define XMEGA_NVM_CMD_LOADFLASHPAGEBUFF      0x23
+		#define XMEGA_NVM_CMD_ERASEFLASHPAGEBUFF     0x26
+		#define XMEGA_NVM_CMD_ERASEFLASHPAGE         0x2B
+		#define XMEGA_NVM_CMD_WRITEFLASHPAGE         0x2E
+		#define XMEGA_NVM_CMD_ERASEWRITEFLASH        0x2F
+		#define XMEGA_NVM_CMD_FLASHCRC               0x78
+		#define XMEGA_NVM_CMD_ERASEAPPSEC            0x20
+		#define XMEGA_NVM_CMD_ERASEAPPSECPAGE        0x22
+		#define XMEGA_NVM_CMD_WRITEAPPSECPAGE        0x24
+		#define XMEGA_NVM_CMD_ERASEWRITEAPPSECPAGE   0x25
+		#define XMEGA_NVM_CMD_APPCRC                 0x38
+		#define XMEGA_NVM_CMD_ERASEBOOTSEC           0x68
+		#define XMEGA_NVM_CMD_ERASEBOOTSECPAGE       0x2A
+		#define XMEGA_NVM_CMD_WRITEBOOTSECPAGE       0x2C
+		#define XMEGA_NVM_CMD_ERASEWRITEBOOTSECPAGE  0x2D
+		#define XMEGA_NVM_CMD_BOOTCRC                0x39
+		#define XMEGA_NVM_CMD_READUSERSIG            0x03
+		#define XMEGA_NVM_CMD_ERASEUSERSIG           0x18
+		#define XMEGA_NVM_CMD_WRITEUSERSIG           0x1A
+		#define XMEGA_NVM_CMD_READCALIBRATION        0x02
+		#define XMEGA_NVM_CMD_READFUSE               0x07
+		#define XMEGA_NVM_CMD_WRITEFUSE              0x4C
+		#define XMEGA_NVM_CMD_WRITELOCK              0x08
+		#define XMEGA_NVM_CMD_LOADEEPROMPAGEBUFF     0x33
+		#define XMEGA_NVM_CMD_ERASEEEPROMPAGEBUFF    0x36
+		#define XMEGA_NVM_CMD_ERASEEEPROM            0x30
+		#define XMEGA_NVM_CMD_ERASEEEPROMPAGE        0x32
+		#define XMEGA_NVM_CMD_WRITEEEPROMPAGE        0x34
+		#define XMEGA_NVM_CMD_ERASEWRITEEEPROMPAGE   0x35
+		#define XMEGA_NVM_CMD_READEEPROM             0x06
+
+	/* Function Prototypes: */
+		bool XMEGANVM_WaitWhileNVMBusBusy(void);
+		bool XMEGANVM_WaitWhileNVMControllerBusy(void);
+		bool XMEGANVM_GetMemoryCRC(const uint8_t CRCCommand, uint32_t* const CRCDest);
+		bool XMEGANVM_ReadMemory(const uint32_t ReadAddress, uint8_t* ReadBuffer, uint16_t ReadSize);
+		bool XMEGANVM_WriteByteMemory(const uint8_t WriteCommand, const uint32_t WriteAddress, const uint8_t Byte);
+		bool XMEGANVM_WritePageMemory(const uint8_t WriteBuffCommand, const uint8_t EraseBuffCommand,
+		                              const uint8_t WritePageCommand, const uint8_t PageMode, const uint32_t WriteAddress,
+		                              const uint8_t* WriteBuffer, uint16_t WriteSize);
+		bool XMEGANVM_EraseMemory(const uint8_t EraseCommand, const uint32_t Address);
+
+		#if defined(INCLUDE_FROM_XMEGANVM_C)
+			static void XMEGANVM_SendNVMRegAddress(const uint8_t Register);
+			static void XMEGANVM_SendAddress(const uint32_t AbsoluteAddress);		
+		#endif
+
+#endif
diff --git a/Projects/AVRISP-MKII/Lib/XPROG/XPROGProtocol.c b/Projects/AVRISP-MKII/Lib/XPROG/XPROGProtocol.c
index cc521ce87..7a4b1a547 100644
--- a/Projects/AVRISP-MKII/Lib/XPROG/XPROGProtocol.c
+++ b/Projects/AVRISP-MKII/Lib/XPROG/XPROGProtocol.c
@@ -1,514 +1,514 @@
-/*

-             LUFA Library

-     Copyright (C) Dean Camera, 2010.

-              

-  dean [at] fourwalledcubicle [dot] com

-      www.fourwalledcubicle.com

-*/

-

-/*

-  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)

-

-  Permission to use, copy, modify, distribute, and sell this 

-  software and its documentation for any purpose is hereby granted

-  without fee, provided that the above copyright notice appear in 

-  all copies and that both that the copyright notice and this

-  permission notice and warranty disclaimer appear in supporting 

-  documentation, and that the name of the author not be used in 

-  advertising or publicity pertaining to distribution of the 

-  software without specific, written prior permission.

-

-  The author disclaim all warranties with regard to this

-  software, including all implied warranties of merchantability

-  and fitness.  In no event shall the author be liable for any

-  special, indirect or consequential damages or any damages

-  whatsoever resulting from loss of use, data or profits, whether

-  in an action of contract, negligence or other tortious action,

-  arising out of or in connection with the use or performance of

-  this software.

-*/

-

-/** \file

- *

- *  XPROG Protocol handler, to process V2 Protocol wrapped XPROG commands used in Atmel programmer devices.

- */

-

-#define  INCLUDE_FROM_XPROGPROTOCOL_C

-#include "XPROGProtocol.h"

-

-#if defined(ENABLE_XPROG_PROTOCOL) || defined(__DOXYGEN__)

-/** Base absolute address for the target's NVM controller for PDI programming */

-uint32_t XPROG_Param_NVMBase = 0x010001C0;

-

-/** Size in bytes of the target's EEPROM page */

-uint16_t XPROG_Param_EEPageSize;

-

-/** Address of the TPI device's NVMCMD register for TPI programming */

-uint8_t  XPROG_Param_NVMCMDRegAddr;

-

-/** Address of the TPI device's NVMCSR register for TPI programming */

-uint8_t  XPROG_Param_NVMCSRRegAddr;

-

-/** Currently selected XPROG programming protocol */

-uint8_t  XPROG_SelectedProtocol = XPRG_PROTOCOL_PDI;

-

-/** Handler for the CMD_XPROG_SETMODE command, which sets the programmer-to-target protocol used for PDI/TPI

- *  programming.

- */

-void XPROGProtocol_SetMode(void)

-{

-	struct

-	{

-		uint8_t Protocol;

-	} SetMode_XPROG_Params;

-	

-	Endpoint_Read_Stream_LE(&SetMode_XPROG_Params, sizeof(SetMode_XPROG_Params), NO_STREAM_CALLBACK);

-

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-	

-	XPROG_SelectedProtocol = SetMode_XPROG_Params.Protocol;

-	

-	Endpoint_Write_Byte(CMD_XPROG_SETMODE);

-	Endpoint_Write_Byte((SetMode_XPROG_Params.Protocol != XPRG_PROTOCOL_JTAG) ? STATUS_CMD_OK : STATUS_CMD_FAILED);

-	Endpoint_ClearIN();	

-}

-

-/** Handler for the CMD_XPROG command, which wraps up XPROG commands in a V2 wrapper which need to be

- *  removed and processed so that the underlying XPROG command can be handled.

- */

-void XPROGProtocol_Command(void)

-{

-	uint8_t XPROGCommand = Endpoint_Read_Byte();

-	

-	switch (XPROGCommand)

-	{

-		case XPRG_CMD_ENTER_PROGMODE:

-			XPROGProtocol_EnterXPROGMode();

-			break;

-		case XPRG_CMD_LEAVE_PROGMODE:

-			XPROGProtocol_LeaveXPROGMode();

-			break;

-		case XPRG_CMD_ERASE:

-			XPROGProtocol_Erase();

-			break;

-		case XPRG_CMD_WRITE_MEM:

-			XPROGProtocol_WriteMemory();

-			break;

-		case XPRG_CMD_READ_MEM:

-			XPROGProtocol_ReadMemory();

-			break;

-		case XPRG_CMD_CRC:

-			XPROGProtocol_ReadCRC();

-			break;

-		case XPRG_CMD_SET_PARAM:

-			XPROGProtocol_SetParam();

-			break;

-	}

-}

-

-/** Handler for the XPROG ENTER_PROGMODE command to establish a connection with the attached device. */

-static void XPROGProtocol_EnterXPROGMode(void)

-{

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-	

-	bool NVMBusEnabled;

-

-	if (XPROG_SelectedProtocol == XPRG_PROTOCOL_PDI)

-	{

-		/* Enable PDI programming mode with the attached target */

-		XPROGTarget_EnableTargetPDI();

-

-		/* Store the RESET key into the RESET PDI register to keep the XMEGA in reset */

-		XPROGTarget_SendByte(PDI_CMD_STCS | PDI_RESET_REG);	

-		XPROGTarget_SendByte(PDI_RESET_KEY);

-

-		/* Lower direction change guard time to 0 USART bits */

-		XPROGTarget_SendByte(PDI_CMD_STCS | PDI_CTRL_REG);	

-		XPROGTarget_SendByte(0x07);

-

-		/* Enable access to the XPROG NVM bus by sending the documented NVM access key to the device */

-		XPROGTarget_SendByte(PDI_CMD_KEY);	

-		for (uint8_t i = sizeof(PDI_NVMENABLE_KEY); i > 0; i--)

-		  XPROGTarget_SendByte(PDI_NVMENABLE_KEY[i - 1]);

-

-		/* Wait until the NVM bus becomes active */

-		NVMBusEnabled = XMEGANVM_WaitWhileNVMBusBusy();

-	}

-	else

-	{

-		/* Enable TPI programming mode with the attached target */

-		XPROGTarget_EnableTargetTPI();

-		

-		/* Lower direction change guard time to 0 USART bits */

-		XPROGTarget_SendByte(TPI_CMD_SSTCS | TPI_CTRL_REG);

-		XPROGTarget_SendByte(0x07);

-		

-		/* Enable access to the XPROG NVM bus by sending the documented NVM access key to the device */

-		XPROGTarget_SendByte(TPI_CMD_SKEY);	

-		for (uint8_t i = sizeof(TPI_NVMENABLE_KEY); i > 0; i--)

-		  XPROGTarget_SendByte(TPI_NVMENABLE_KEY[i - 1]);

-

-		/* Wait until the NVM bus becomes active */

-		NVMBusEnabled = TINYNVM_WaitWhileNVMBusBusy();

-	}

-	

-	Endpoint_Write_Byte(CMD_XPROG);

-	Endpoint_Write_Byte(XPRG_CMD_ENTER_PROGMODE);

-	Endpoint_Write_Byte(NVMBusEnabled ? XPRG_ERR_OK : XPRG_ERR_FAILED);

-	Endpoint_ClearIN();

-}

-

-/** Handler for the XPROG LEAVE_PROGMODE command to terminate the PDI programming connection with

- *  the attached device.

- */

-static void XPROGProtocol_LeaveXPROGMode(void)

-{

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-	

-	if (XPROG_SelectedProtocol == XPRG_PROTOCOL_PDI)

-	{

-		XMEGANVM_WaitWhileNVMBusBusy();

-

-		/* Clear the RESET key in the RESET PDI register to allow the XMEGA to run */

-		XPROGTarget_SendByte(PDI_CMD_STCS | PDI_RESET_REG);	

-		XPROGTarget_SendByte(0x00);

-

-		/* Do it twice to make sure it takes affect (silicon bug?) */

-		XPROGTarget_SendByte(PDI_CMD_STCS | PDI_RESET_REG);	

-		XPROGTarget_SendByte(0x00);

-

-		XPROGTarget_DisableTargetPDI();

-	}

-	else

-	{

-		TINYNVM_WaitWhileNVMBusBusy();

-

-		/* Clear the NVMEN bit in the TPI CONTROL register to disable TPI mode */

-		XPROGTarget_SendByte(TPI_CMD_SSTCS | TPI_CTRL_REG);	

-		XPROGTarget_SendByte(0x00);

-	

-		XPROGTarget_DisableTargetTPI();

-	}

-	

-	Endpoint_Write_Byte(CMD_XPROG);

-	Endpoint_Write_Byte(XPRG_CMD_LEAVE_PROGMODE);

-	Endpoint_Write_Byte(XPRG_ERR_OK);

-	Endpoint_ClearIN();

-}

-

-/** Handler for the XPRG ERASE command to erase a specific memory address space in the attached device. */

-static void XPROGProtocol_Erase(void)

-{

-	uint8_t ReturnStatus = XPRG_ERR_OK;

-

-	struct

-	{

-		uint8_t  MemoryType;

-		uint32_t Address;

-	} Erase_XPROG_Params;

-

-	Endpoint_Read_Stream_LE(&Erase_XPROG_Params, sizeof(Erase_XPROG_Params), NO_STREAM_CALLBACK);

-	Erase_XPROG_Params.Address = SwapEndian_32(Erase_XPROG_Params.Address);

-

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-	

-	uint8_t EraseCommand;

-

-	if (XPROG_SelectedProtocol == XPRG_PROTOCOL_PDI)

-	{	

-		/* Determine which NVM command to send to the device depending on the memory to erase */

-		switch (Erase_XPROG_Params.MemoryType)

-		{

-			case XPRG_ERASE_CHIP:

-				EraseCommand = XMEGA_NVM_CMD_CHIPERASE;

-				break;

-			case XPRG_ERASE_APP:

-				EraseCommand = XMEGA_NVM_CMD_ERASEAPPSEC;

-				break;

-			case XPRG_ERASE_BOOT:

-				EraseCommand = XMEGA_NVM_CMD_ERASEBOOTSEC;

-				break;

-			case XPRG_ERASE_EEPROM:

-				EraseCommand = XMEGA_NVM_CMD_ERASEEEPROM;

-				break;

-			case XPRG_ERASE_APP_PAGE:

-				EraseCommand = XMEGA_NVM_CMD_ERASEAPPSECPAGE;

-				break;

-			case XPRG_ERASE_BOOT_PAGE:

-				EraseCommand = XMEGA_NVM_CMD_ERASEBOOTSECPAGE;

-				break;

-			case XPRG_ERASE_EEPROM_PAGE:

-				EraseCommand = XMEGA_NVM_CMD_ERASEEEPROMPAGE;

-				break;

-			case XPRG_ERASE_USERSIG:

-				EraseCommand = XMEGA_NVM_CMD_ERASEUSERSIG;

-				break;

-			default:

-				EraseCommand = XMEGA_NVM_CMD_NOOP;

-				break;

-		}

-		

-		/* Erase the target memory, indicate timeout if ocurred */

-		if (!(XMEGANVM_EraseMemory(EraseCommand, Erase_XPROG_Params.Address)))

-		  ReturnStatus = XPRG_ERR_TIMEOUT;

-	}

-	else

-	{

-		if (Erase_XPROG_Params.MemoryType == XPRG_ERASE_CHIP)

-		  EraseCommand = TINY_NVM_CMD_CHIPERASE;

-		else

-		  EraseCommand = TINY_NVM_CMD_SECTIONERASE;

-	

-		/* Erase the target memory, indicate timeout if ocurred */

-		if (!(TINYNVM_EraseMemory(EraseCommand, Erase_XPROG_Params.Address)))

-		  ReturnStatus = XPRG_ERR_TIMEOUT;

-	}

-	

-	Endpoint_Write_Byte(CMD_XPROG);

-	Endpoint_Write_Byte(XPRG_CMD_ERASE);

-	Endpoint_Write_Byte(ReturnStatus);

-	Endpoint_ClearIN();	

-}

-

-/** Handler for the XPROG WRITE_MEMORY command to write to a specific memory space within the attached device. */

-static void XPROGProtocol_WriteMemory(void)

-{

-	uint8_t ReturnStatus = XPRG_ERR_OK;

-

-	struct

-	{

-		uint8_t  MemoryType;

-		uint8_t  PageMode;

-		uint32_t Address;

-		uint16_t Length;

-		uint8_t  ProgData[256];

-	} WriteMemory_XPROG_Params;

-	

-	Endpoint_Read_Stream_LE(&WriteMemory_XPROG_Params, (sizeof(WriteMemory_XPROG_Params) -

-	                                                    sizeof(WriteMemory_XPROG_Params).ProgData), NO_STREAM_CALLBACK);

-	WriteMemory_XPROG_Params.Address = SwapEndian_32(WriteMemory_XPROG_Params.Address);

-	WriteMemory_XPROG_Params.Length  = SwapEndian_16(WriteMemory_XPROG_Params.Length);

-	Endpoint_Read_Stream_LE(&WriteMemory_XPROG_Params.ProgData, WriteMemory_XPROG_Params.Length, NO_STREAM_CALLBACK);

-

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-

-	if (XPROG_SelectedProtocol == XPRG_PROTOCOL_PDI)

-	{

-		/* Assume FLASH page programming by default, as it is the common case */

-		uint8_t WriteCommand     = XMEGA_NVM_CMD_WRITEFLASHPAGE;

-		uint8_t WriteBuffCommand = XMEGA_NVM_CMD_LOADFLASHPAGEBUFF;

-		uint8_t EraseBuffCommand = XMEGA_NVM_CMD_ERASEFLASHPAGEBUFF;

-		bool    PagedMemory      = true;

-		

-		switch (WriteMemory_XPROG_Params.MemoryType)

-		{

-			case XPRG_MEM_TYPE_APPL:

-				WriteCommand     = XMEGA_NVM_CMD_WRITEAPPSECPAGE;

-				break;

-			case XPRG_MEM_TYPE_BOOT:

-				WriteCommand     = XMEGA_NVM_CMD_WRITEBOOTSECPAGE;

-				break;

-			case XPRG_MEM_TYPE_EEPROM:

-				WriteCommand     = XMEGA_NVM_CMD_WRITEEEPROMPAGE;

-				WriteBuffCommand = XMEGA_NVM_CMD_LOADEEPROMPAGEBUFF;

-				EraseBuffCommand = XMEGA_NVM_CMD_ERASEEEPROMPAGEBUFF;			

-				break;

-			case XPRG_MEM_TYPE_USERSIG:

-				/* User signature is paged, but needs us to manually indicate the mode bits since the host doesn't set them */

-				WriteMemory_XPROG_Params.PageMode = (XPRG_PAGEMODE_ERASE | XPRG_PAGEMODE_WRITE);

-				WriteCommand     = XMEGA_NVM_CMD_WRITEUSERSIG;

-				break;

-			case XPRG_MEM_TYPE_FUSE:

-				WriteCommand     = XMEGA_NVM_CMD_WRITEFUSE;

-				PagedMemory      = false;

-				break;

-			case XPRG_MEM_TYPE_LOCKBITS:

-				WriteCommand     = XMEGA_NVM_CMD_WRITELOCK;

-				PagedMemory      = false;

-				break;

-		}

-		

-		/* Send the appropriate memory write commands to the device, indicate timeout if occurred */

-		if ((PagedMemory && !(XMEGANVM_WritePageMemory(WriteBuffCommand, EraseBuffCommand, WriteCommand, 

-													   WriteMemory_XPROG_Params.PageMode, WriteMemory_XPROG_Params.Address,

-													   WriteMemory_XPROG_Params.ProgData, WriteMemory_XPROG_Params.Length))) ||

-		   (!PagedMemory && !(XMEGANVM_WriteByteMemory(WriteCommand, WriteMemory_XPROG_Params.Address,

-													   WriteMemory_XPROG_Params.ProgData[0]))))

-		{

-			ReturnStatus = XPRG_ERR_TIMEOUT;

-		}

-	}

-	else

-	{

-		/* Send write command to the TPI device, indicate timeout if occurred */

-		if (!(TINYNVM_WriteMemory(WriteMemory_XPROG_Params.Address, WriteMemory_XPROG_Params.ProgData,

-		      WriteMemory_XPROG_Params.Length)))

-		{

-			ReturnStatus = XPRG_ERR_TIMEOUT;

-		}

-	}

-	

-	Endpoint_Write_Byte(CMD_XPROG);

-	Endpoint_Write_Byte(XPRG_CMD_WRITE_MEM);

-	Endpoint_Write_Byte(ReturnStatus);	

-	Endpoint_ClearIN();

-}

-

-/** Handler for the XPROG READ_MEMORY command to read data from a specific address space within the

- *  attached device.

- */

-static void XPROGProtocol_ReadMemory(void)

-{

-	uint8_t ReturnStatus = XPRG_ERR_OK;

-

-	struct

-	{

-		uint8_t  MemoryType;

-		uint32_t Address;

-		uint16_t Length;

-	} ReadMemory_XPROG_Params;

-	

-	Endpoint_Read_Stream_LE(&ReadMemory_XPROG_Params, sizeof(ReadMemory_XPROG_Params), NO_STREAM_CALLBACK);

-	ReadMemory_XPROG_Params.Address = SwapEndian_32(ReadMemory_XPROG_Params.Address);

-	ReadMemory_XPROG_Params.Length  = SwapEndian_16(ReadMemory_XPROG_Params.Length);

-

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-

-	uint8_t ReadBuffer[256];

-	

-	if (XPROG_SelectedProtocol == XPRG_PROTOCOL_PDI)

-	{

-		/* Read the PDI target's memory, indicate timeout if occurred */

-		if (!(XMEGANVM_ReadMemory(ReadMemory_XPROG_Params.Address, ReadBuffer, ReadMemory_XPROG_Params.Length)))

-		  ReturnStatus = XPRG_ERR_TIMEOUT;

-	}

-	else

-	{

-		/* Read the TPI target's memory, indicate timeout if occurred */

-		if (!(TINYNVM_ReadMemory(ReadMemory_XPROG_Params.Address, ReadBuffer, ReadMemory_XPROG_Params.Length)))

-		  ReturnStatus = XPRG_ERR_TIMEOUT;

-	}

-

-	Endpoint_Write_Byte(CMD_XPROG);

-	Endpoint_Write_Byte(XPRG_CMD_READ_MEM);

-	Endpoint_Write_Byte(ReturnStatus);

-	

-	if (ReturnStatus == XPRG_ERR_OK)

-	  Endpoint_Write_Stream_LE(ReadBuffer, ReadMemory_XPROG_Params.Length, NO_STREAM_CALLBACK);

-	

-	Endpoint_ClearIN();

-}

-

-/** Handler for the XPROG CRC command to read a specific memory space's CRC value for comparison between the

- *  attached device's memory and a data set on the host.

- */

-static void XPROGProtocol_ReadCRC(void)

-{

-	uint8_t ReturnStatus = XPRG_ERR_OK;

-	

-	struct

-	{

-		uint8_t CRCType;

-	} ReadCRC_XPROG_Params;

-	

-	Endpoint_Read_Stream_LE(&ReadCRC_XPROG_Params, sizeof(ReadCRC_XPROG_Params), NO_STREAM_CALLBACK);

-

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-	

-	uint32_t MemoryCRC;

-

-	if (XPROG_SelectedProtocol == XPRG_PROTOCOL_PDI)

-	{

-		uint8_t CRCCommand;

-

-		/* Determine which NVM command to send to the device depending on the memory to CRC */

-		switch (ReadCRC_XPROG_Params.CRCType)

-		{

-			case XPRG_CRC_APP:

-				CRCCommand = XMEGA_NVM_CMD_APPCRC;

-				break;

-			case XPRG_CRC_BOOT:

-				CRCCommand = XMEGA_NVM_CMD_BOOTCRC;

-				break;

-			default:

-				CRCCommand = XMEGA_NVM_CMD_FLASHCRC;

-				break;

-		}

-		

-		/* Perform and retrieve the memory CRC, indicate timeout if occurred */

-		if (!(XMEGANVM_GetMemoryCRC(CRCCommand, &MemoryCRC)))

-		  ReturnStatus = XPRG_ERR_TIMEOUT;

-	}

-	else

-	{

-		/* TPI does not support memory CRC */

-		ReturnStatus = XPRG_ERR_FAILED;

-	}

-	

-	Endpoint_Write_Byte(CMD_XPROG);

-	Endpoint_Write_Byte(XPRG_CMD_CRC);

-	Endpoint_Write_Byte(ReturnStatus);

-	

-	if (ReturnStatus == XPRG_ERR_OK)

-	{

-		Endpoint_Write_Byte(MemoryCRC >> 16);

-		Endpoint_Write_Word_LE(MemoryCRC & 0xFFFF);		

-	}

-	

-	Endpoint_ClearIN();	

-}

-

-/** Handler for the XPROG SET_PARAM command to set a XPROG parameter for use when communicating with the

- *  attached device.

- */

-static void XPROGProtocol_SetParam(void)

-{

-	uint8_t ReturnStatus = XPRG_ERR_OK;

-

-	uint8_t XPROGParam = Endpoint_Read_Byte();

-	

-	/* Determine which parameter is being set, store the new parameter value */

-	switch (XPROGParam)

-	{

-		case XPRG_PARAM_NVMBASE:

-			XPROG_Param_NVMBase = Endpoint_Read_DWord_BE();

-			break;

-		case XPRG_PARAM_EEPPAGESIZE:

-			XPROG_Param_EEPageSize = Endpoint_Read_Word_BE();

-			break;

-		case XPRG_PARAM_NVMCMD_REG:

-			XPROG_Param_NVMCMDRegAddr = Endpoint_Read_Byte();

-			break;

-		case XPRG_PARAM_NVMCSR_REG:

-			XPROG_Param_NVMCSRRegAddr = Endpoint_Read_Byte();

-			break;

-		default:

-			ReturnStatus = XPRG_ERR_FAILED;

-			break;

-	}

-

-	Endpoint_ClearOUT();

-	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);

-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);

-		  

-	Endpoint_Write_Byte(CMD_XPROG);

-	Endpoint_Write_Byte(XPRG_CMD_SET_PARAM);

-	Endpoint_Write_Byte(ReturnStatus);

-	Endpoint_ClearIN();

-}

-

-#endif

+/*
+             LUFA Library
+     Copyright (C) Dean Camera, 2010.
+              
+  dean [at] fourwalledcubicle [dot] com
+      www.fourwalledcubicle.com
+*/
+
+/*
+  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)
+
+  Permission to use, copy, modify, distribute, and sell this 
+  software and its documentation for any purpose is hereby granted
+  without fee, provided that the above copyright notice appear in 
+  all copies and that both that the copyright notice and this
+  permission notice and warranty disclaimer appear in supporting 
+  documentation, and that the name of the author not be used in 
+  advertising or publicity pertaining to distribution of the 
+  software without specific, written prior permission.
+
+  The author disclaim all warranties with regard to this
+  software, including all implied warranties of merchantability
+  and fitness.  In no event shall the author be liable for any
+  special, indirect or consequential damages or any damages
+  whatsoever resulting from loss of use, data or profits, whether
+  in an action of contract, negligence or other tortious action,
+  arising out of or in connection with the use or performance of
+  this software.
+*/
+
+/** \file
+ *
+ *  XPROG Protocol handler, to process V2 Protocol wrapped XPROG commands used in Atmel programmer devices.
+ */
+
+#define  INCLUDE_FROM_XPROGPROTOCOL_C
+#include "XPROGProtocol.h"
+
+#if defined(ENABLE_XPROG_PROTOCOL) || defined(__DOXYGEN__)
+/** Base absolute address for the target's NVM controller for PDI programming */
+uint32_t XPROG_Param_NVMBase = 0x010001C0;
+
+/** Size in bytes of the target's EEPROM page */
+uint16_t XPROG_Param_EEPageSize;
+
+/** Address of the TPI device's NVMCMD register for TPI programming */
+uint8_t  XPROG_Param_NVMCMDRegAddr;
+
+/** Address of the TPI device's NVMCSR register for TPI programming */
+uint8_t  XPROG_Param_NVMCSRRegAddr;
+
+/** Currently selected XPROG programming protocol */
+uint8_t  XPROG_SelectedProtocol = XPRG_PROTOCOL_PDI;
+
+/** Handler for the CMD_XPROG_SETMODE command, which sets the programmer-to-target protocol used for PDI/TPI
+ *  programming.
+ */
+void XPROGProtocol_SetMode(void)
+{
+	struct
+	{
+		uint8_t Protocol;
+	} SetMode_XPROG_Params;
+	
+	Endpoint_Read_Stream_LE(&SetMode_XPROG_Params, sizeof(SetMode_XPROG_Params), NO_STREAM_CALLBACK);
+
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+	
+	XPROG_SelectedProtocol = SetMode_XPROG_Params.Protocol;
+	
+	Endpoint_Write_Byte(CMD_XPROG_SETMODE);
+	Endpoint_Write_Byte((SetMode_XPROG_Params.Protocol != XPRG_PROTOCOL_JTAG) ? STATUS_CMD_OK : STATUS_CMD_FAILED);
+	Endpoint_ClearIN();	
+}
+
+/** Handler for the CMD_XPROG command, which wraps up XPROG commands in a V2 wrapper which need to be
+ *  removed and processed so that the underlying XPROG command can be handled.
+ */
+void XPROGProtocol_Command(void)
+{
+	uint8_t XPROGCommand = Endpoint_Read_Byte();
+	
+	switch (XPROGCommand)
+	{
+		case XPRG_CMD_ENTER_PROGMODE:
+			XPROGProtocol_EnterXPROGMode();
+			break;
+		case XPRG_CMD_LEAVE_PROGMODE:
+			XPROGProtocol_LeaveXPROGMode();
+			break;
+		case XPRG_CMD_ERASE:
+			XPROGProtocol_Erase();
+			break;
+		case XPRG_CMD_WRITE_MEM:
+			XPROGProtocol_WriteMemory();
+			break;
+		case XPRG_CMD_READ_MEM:
+			XPROGProtocol_ReadMemory();
+			break;
+		case XPRG_CMD_CRC:
+			XPROGProtocol_ReadCRC();
+			break;
+		case XPRG_CMD_SET_PARAM:
+			XPROGProtocol_SetParam();
+			break;
+	}
+}
+
+/** Handler for the XPROG ENTER_PROGMODE command to establish a connection with the attached device. */
+static void XPROGProtocol_EnterXPROGMode(void)
+{
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+	
+	bool NVMBusEnabled;
+
+	if (XPROG_SelectedProtocol == XPRG_PROTOCOL_PDI)
+	{
+		/* Enable PDI programming mode with the attached target */
+		XPROGTarget_EnableTargetPDI();
+
+		/* Store the RESET key into the RESET PDI register to keep the XMEGA in reset */
+		XPROGTarget_SendByte(PDI_CMD_STCS | PDI_RESET_REG);	
+		XPROGTarget_SendByte(PDI_RESET_KEY);
+
+		/* Lower direction change guard time to 0 USART bits */
+		XPROGTarget_SendByte(PDI_CMD_STCS | PDI_CTRL_REG);	
+		XPROGTarget_SendByte(0x07);
+
+		/* Enable access to the XPROG NVM bus by sending the documented NVM access key to the device */
+		XPROGTarget_SendByte(PDI_CMD_KEY);	
+		for (uint8_t i = sizeof(PDI_NVMENABLE_KEY); i > 0; i--)
+		  XPROGTarget_SendByte(PDI_NVMENABLE_KEY[i - 1]);
+
+		/* Wait until the NVM bus becomes active */
+		NVMBusEnabled = XMEGANVM_WaitWhileNVMBusBusy();
+	}
+	else
+	{
+		/* Enable TPI programming mode with the attached target */
+		XPROGTarget_EnableTargetTPI();
+		
+		/* Lower direction change guard time to 0 USART bits */
+		XPROGTarget_SendByte(TPI_CMD_SSTCS | TPI_CTRL_REG);
+		XPROGTarget_SendByte(0x07);
+		
+		/* Enable access to the XPROG NVM bus by sending the documented NVM access key to the device */
+		XPROGTarget_SendByte(TPI_CMD_SKEY);	
+		for (uint8_t i = sizeof(TPI_NVMENABLE_KEY); i > 0; i--)
+		  XPROGTarget_SendByte(TPI_NVMENABLE_KEY[i - 1]);
+
+		/* Wait until the NVM bus becomes active */
+		NVMBusEnabled = TINYNVM_WaitWhileNVMBusBusy();
+	}
+	
+	Endpoint_Write_Byte(CMD_XPROG);
+	Endpoint_Write_Byte(XPRG_CMD_ENTER_PROGMODE);
+	Endpoint_Write_Byte(NVMBusEnabled ? XPRG_ERR_OK : XPRG_ERR_FAILED);
+	Endpoint_ClearIN();
+}
+
+/** Handler for the XPROG LEAVE_PROGMODE command to terminate the PDI programming connection with
+ *  the attached device.
+ */
+static void XPROGProtocol_LeaveXPROGMode(void)
+{
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+	
+	if (XPROG_SelectedProtocol == XPRG_PROTOCOL_PDI)
+	{
+		XMEGANVM_WaitWhileNVMBusBusy();
+
+		/* Clear the RESET key in the RESET PDI register to allow the XMEGA to run */
+		XPROGTarget_SendByte(PDI_CMD_STCS | PDI_RESET_REG);	
+		XPROGTarget_SendByte(0x00);
+
+		/* Do it twice to make sure it takes affect (silicon bug?) */
+		XPROGTarget_SendByte(PDI_CMD_STCS | PDI_RESET_REG);	
+		XPROGTarget_SendByte(0x00);
+
+		XPROGTarget_DisableTargetPDI();
+	}
+	else
+	{
+		TINYNVM_WaitWhileNVMBusBusy();
+
+		/* Clear the NVMEN bit in the TPI CONTROL register to disable TPI mode */
+		XPROGTarget_SendByte(TPI_CMD_SSTCS | TPI_CTRL_REG);	
+		XPROGTarget_SendByte(0x00);
+	
+		XPROGTarget_DisableTargetTPI();
+	}
+	
+	Endpoint_Write_Byte(CMD_XPROG);
+	Endpoint_Write_Byte(XPRG_CMD_LEAVE_PROGMODE);
+	Endpoint_Write_Byte(XPRG_ERR_OK);
+	Endpoint_ClearIN();
+}
+
+/** Handler for the XPRG ERASE command to erase a specific memory address space in the attached device. */
+static void XPROGProtocol_Erase(void)
+{
+	uint8_t ReturnStatus = XPRG_ERR_OK;
+
+	struct
+	{
+		uint8_t  MemoryType;
+		uint32_t Address;
+	} Erase_XPROG_Params;
+
+	Endpoint_Read_Stream_LE(&Erase_XPROG_Params, sizeof(Erase_XPROG_Params), NO_STREAM_CALLBACK);
+	Erase_XPROG_Params.Address = SwapEndian_32(Erase_XPROG_Params.Address);
+
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+	
+	uint8_t EraseCommand;
+
+	if (XPROG_SelectedProtocol == XPRG_PROTOCOL_PDI)
+	{	
+		/* Determine which NVM command to send to the device depending on the memory to erase */
+		switch (Erase_XPROG_Params.MemoryType)
+		{
+			case XPRG_ERASE_CHIP:
+				EraseCommand = XMEGA_NVM_CMD_CHIPERASE;
+				break;
+			case XPRG_ERASE_APP:
+				EraseCommand = XMEGA_NVM_CMD_ERASEAPPSEC;
+				break;
+			case XPRG_ERASE_BOOT:
+				EraseCommand = XMEGA_NVM_CMD_ERASEBOOTSEC;
+				break;
+			case XPRG_ERASE_EEPROM:
+				EraseCommand = XMEGA_NVM_CMD_ERASEEEPROM;
+				break;
+			case XPRG_ERASE_APP_PAGE:
+				EraseCommand = XMEGA_NVM_CMD_ERASEAPPSECPAGE;
+				break;
+			case XPRG_ERASE_BOOT_PAGE:
+				EraseCommand = XMEGA_NVM_CMD_ERASEBOOTSECPAGE;
+				break;
+			case XPRG_ERASE_EEPROM_PAGE:
+				EraseCommand = XMEGA_NVM_CMD_ERASEEEPROMPAGE;
+				break;
+			case XPRG_ERASE_USERSIG:
+				EraseCommand = XMEGA_NVM_CMD_ERASEUSERSIG;
+				break;
+			default:
+				EraseCommand = XMEGA_NVM_CMD_NOOP;
+				break;
+		}
+		
+		/* Erase the target memory, indicate timeout if ocurred */
+		if (!(XMEGANVM_EraseMemory(EraseCommand, Erase_XPROG_Params.Address)))
+		  ReturnStatus = XPRG_ERR_TIMEOUT;
+	}
+	else
+	{
+		if (Erase_XPROG_Params.MemoryType == XPRG_ERASE_CHIP)
+		  EraseCommand = TINY_NVM_CMD_CHIPERASE;
+		else
+		  EraseCommand = TINY_NVM_CMD_SECTIONERASE;
+	
+		/* Erase the target memory, indicate timeout if ocurred */
+		if (!(TINYNVM_EraseMemory(EraseCommand, Erase_XPROG_Params.Address)))
+		  ReturnStatus = XPRG_ERR_TIMEOUT;
+	}
+	
+	Endpoint_Write_Byte(CMD_XPROG);
+	Endpoint_Write_Byte(XPRG_CMD_ERASE);
+	Endpoint_Write_Byte(ReturnStatus);
+	Endpoint_ClearIN();	
+}
+
+/** Handler for the XPROG WRITE_MEMORY command to write to a specific memory space within the attached device. */
+static void XPROGProtocol_WriteMemory(void)
+{
+	uint8_t ReturnStatus = XPRG_ERR_OK;
+
+	struct
+	{
+		uint8_t  MemoryType;
+		uint8_t  PageMode;
+		uint32_t Address;
+		uint16_t Length;
+		uint8_t  ProgData[256];
+	} WriteMemory_XPROG_Params;
+	
+	Endpoint_Read_Stream_LE(&WriteMemory_XPROG_Params, (sizeof(WriteMemory_XPROG_Params) -
+	                                                    sizeof(WriteMemory_XPROG_Params).ProgData), NO_STREAM_CALLBACK);
+	WriteMemory_XPROG_Params.Address = SwapEndian_32(WriteMemory_XPROG_Params.Address);
+	WriteMemory_XPROG_Params.Length  = SwapEndian_16(WriteMemory_XPROG_Params.Length);
+	Endpoint_Read_Stream_LE(&WriteMemory_XPROG_Params.ProgData, WriteMemory_XPROG_Params.Length, NO_STREAM_CALLBACK);
+
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+
+	if (XPROG_SelectedProtocol == XPRG_PROTOCOL_PDI)
+	{
+		/* Assume FLASH page programming by default, as it is the common case */
+		uint8_t WriteCommand     = XMEGA_NVM_CMD_WRITEFLASHPAGE;
+		uint8_t WriteBuffCommand = XMEGA_NVM_CMD_LOADFLASHPAGEBUFF;
+		uint8_t EraseBuffCommand = XMEGA_NVM_CMD_ERASEFLASHPAGEBUFF;
+		bool    PagedMemory      = true;
+		
+		switch (WriteMemory_XPROG_Params.MemoryType)
+		{
+			case XPRG_MEM_TYPE_APPL:
+				WriteCommand     = XMEGA_NVM_CMD_WRITEAPPSECPAGE;
+				break;
+			case XPRG_MEM_TYPE_BOOT:
+				WriteCommand     = XMEGA_NVM_CMD_WRITEBOOTSECPAGE;
+				break;
+			case XPRG_MEM_TYPE_EEPROM:
+				WriteCommand     = XMEGA_NVM_CMD_WRITEEEPROMPAGE;
+				WriteBuffCommand = XMEGA_NVM_CMD_LOADEEPROMPAGEBUFF;
+				EraseBuffCommand = XMEGA_NVM_CMD_ERASEEEPROMPAGEBUFF;			
+				break;
+			case XPRG_MEM_TYPE_USERSIG:
+				/* User signature is paged, but needs us to manually indicate the mode bits since the host doesn't set them */
+				WriteMemory_XPROG_Params.PageMode = (XPRG_PAGEMODE_ERASE | XPRG_PAGEMODE_WRITE);
+				WriteCommand     = XMEGA_NVM_CMD_WRITEUSERSIG;
+				break;
+			case XPRG_MEM_TYPE_FUSE:
+				WriteCommand     = XMEGA_NVM_CMD_WRITEFUSE;
+				PagedMemory      = false;
+				break;
+			case XPRG_MEM_TYPE_LOCKBITS:
+				WriteCommand     = XMEGA_NVM_CMD_WRITELOCK;
+				PagedMemory      = false;
+				break;
+		}
+		
+		/* Send the appropriate memory write commands to the device, indicate timeout if occurred */
+		if ((PagedMemory && !(XMEGANVM_WritePageMemory(WriteBuffCommand, EraseBuffCommand, WriteCommand, 
+													   WriteMemory_XPROG_Params.PageMode, WriteMemory_XPROG_Params.Address,
+													   WriteMemory_XPROG_Params.ProgData, WriteMemory_XPROG_Params.Length))) ||
+		   (!PagedMemory && !(XMEGANVM_WriteByteMemory(WriteCommand, WriteMemory_XPROG_Params.Address,
+													   WriteMemory_XPROG_Params.ProgData[0]))))
+		{
+			ReturnStatus = XPRG_ERR_TIMEOUT;
+		}
+	}
+	else
+	{
+		/* Send write command to the TPI device, indicate timeout if occurred */
+		if (!(TINYNVM_WriteMemory(WriteMemory_XPROG_Params.Address, WriteMemory_XPROG_Params.ProgData,
+		      WriteMemory_XPROG_Params.Length)))
+		{
+			ReturnStatus = XPRG_ERR_TIMEOUT;
+		}
+	}
+	
+	Endpoint_Write_Byte(CMD_XPROG);
+	Endpoint_Write_Byte(XPRG_CMD_WRITE_MEM);
+	Endpoint_Write_Byte(ReturnStatus);	
+	Endpoint_ClearIN();
+}
+
+/** Handler for the XPROG READ_MEMORY command to read data from a specific address space within the
+ *  attached device.
+ */
+static void XPROGProtocol_ReadMemory(void)
+{
+	uint8_t ReturnStatus = XPRG_ERR_OK;
+
+	struct
+	{
+		uint8_t  MemoryType;
+		uint32_t Address;
+		uint16_t Length;
+	} ReadMemory_XPROG_Params;
+	
+	Endpoint_Read_Stream_LE(&ReadMemory_XPROG_Params, sizeof(ReadMemory_XPROG_Params), NO_STREAM_CALLBACK);
+	ReadMemory_XPROG_Params.Address = SwapEndian_32(ReadMemory_XPROG_Params.Address);
+	ReadMemory_XPROG_Params.Length  = SwapEndian_16(ReadMemory_XPROG_Params.Length);
+
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+
+	uint8_t ReadBuffer[256];
+	
+	if (XPROG_SelectedProtocol == XPRG_PROTOCOL_PDI)
+	{
+		/* Read the PDI target's memory, indicate timeout if occurred */
+		if (!(XMEGANVM_ReadMemory(ReadMemory_XPROG_Params.Address, ReadBuffer, ReadMemory_XPROG_Params.Length)))
+		  ReturnStatus = XPRG_ERR_TIMEOUT;
+	}
+	else
+	{
+		/* Read the TPI target's memory, indicate timeout if occurred */
+		if (!(TINYNVM_ReadMemory(ReadMemory_XPROG_Params.Address, ReadBuffer, ReadMemory_XPROG_Params.Length)))
+		  ReturnStatus = XPRG_ERR_TIMEOUT;
+	}
+
+	Endpoint_Write_Byte(CMD_XPROG);
+	Endpoint_Write_Byte(XPRG_CMD_READ_MEM);
+	Endpoint_Write_Byte(ReturnStatus);
+	
+	if (ReturnStatus == XPRG_ERR_OK)
+	  Endpoint_Write_Stream_LE(ReadBuffer, ReadMemory_XPROG_Params.Length, NO_STREAM_CALLBACK);
+	
+	Endpoint_ClearIN();
+}
+
+/** Handler for the XPROG CRC command to read a specific memory space's CRC value for comparison between the
+ *  attached device's memory and a data set on the host.
+ */
+static void XPROGProtocol_ReadCRC(void)
+{
+	uint8_t ReturnStatus = XPRG_ERR_OK;
+	
+	struct
+	{
+		uint8_t CRCType;
+	} ReadCRC_XPROG_Params;
+	
+	Endpoint_Read_Stream_LE(&ReadCRC_XPROG_Params, sizeof(ReadCRC_XPROG_Params), NO_STREAM_CALLBACK);
+
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+	
+	uint32_t MemoryCRC;
+
+	if (XPROG_SelectedProtocol == XPRG_PROTOCOL_PDI)
+	{
+		uint8_t CRCCommand;
+
+		/* Determine which NVM command to send to the device depending on the memory to CRC */
+		switch (ReadCRC_XPROG_Params.CRCType)
+		{
+			case XPRG_CRC_APP:
+				CRCCommand = XMEGA_NVM_CMD_APPCRC;
+				break;
+			case XPRG_CRC_BOOT:
+				CRCCommand = XMEGA_NVM_CMD_BOOTCRC;
+				break;
+			default:
+				CRCCommand = XMEGA_NVM_CMD_FLASHCRC;
+				break;
+		}
+		
+		/* Perform and retrieve the memory CRC, indicate timeout if occurred */
+		if (!(XMEGANVM_GetMemoryCRC(CRCCommand, &MemoryCRC)))
+		  ReturnStatus = XPRG_ERR_TIMEOUT;
+	}
+	else
+	{
+		/* TPI does not support memory CRC */
+		ReturnStatus = XPRG_ERR_FAILED;
+	}
+	
+	Endpoint_Write_Byte(CMD_XPROG);
+	Endpoint_Write_Byte(XPRG_CMD_CRC);
+	Endpoint_Write_Byte(ReturnStatus);
+	
+	if (ReturnStatus == XPRG_ERR_OK)
+	{
+		Endpoint_Write_Byte(MemoryCRC >> 16);
+		Endpoint_Write_Word_LE(MemoryCRC & 0xFFFF);		
+	}
+	
+	Endpoint_ClearIN();	
+}
+
+/** Handler for the XPROG SET_PARAM command to set a XPROG parameter for use when communicating with the
+ *  attached device.
+ */
+static void XPROGProtocol_SetParam(void)
+{
+	uint8_t ReturnStatus = XPRG_ERR_OK;
+
+	uint8_t XPROGParam = Endpoint_Read_Byte();
+	
+	/* Determine which parameter is being set, store the new parameter value */
+	switch (XPROGParam)
+	{
+		case XPRG_PARAM_NVMBASE:
+			XPROG_Param_NVMBase = Endpoint_Read_DWord_BE();
+			break;
+		case XPRG_PARAM_EEPPAGESIZE:
+			XPROG_Param_EEPageSize = Endpoint_Read_Word_BE();
+			break;
+		case XPRG_PARAM_NVMCMD_REG:
+			XPROG_Param_NVMCMDRegAddr = Endpoint_Read_Byte();
+			break;
+		case XPRG_PARAM_NVMCSR_REG:
+			XPROG_Param_NVMCSRRegAddr = Endpoint_Read_Byte();
+			break;
+		default:
+			ReturnStatus = XPRG_ERR_FAILED;
+			break;
+	}
+
+	Endpoint_ClearOUT();
+	Endpoint_SelectEndpoint(AVRISP_DATA_IN_EPNUM);
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+		  
+	Endpoint_Write_Byte(CMD_XPROG);
+	Endpoint_Write_Byte(XPRG_CMD_SET_PARAM);
+	Endpoint_Write_Byte(ReturnStatus);
+	Endpoint_ClearIN();
+}
+
+#endif
diff --git a/Projects/AVRISP-MKII/Lib/XPROG/XPROGProtocol.h b/Projects/AVRISP-MKII/Lib/XPROG/XPROGProtocol.h
index 8e5d1b06d..1fdb5a1b8 100644
--- a/Projects/AVRISP-MKII/Lib/XPROG/XPROGProtocol.h
+++ b/Projects/AVRISP-MKII/Lib/XPROG/XPROGProtocol.h
@@ -1,132 +1,132 @@
-/*

-             LUFA Library

-     Copyright (C) Dean Camera, 2010.

-              

-  dean [at] fourwalledcubicle [dot] com

-      www.fourwalledcubicle.com

-*/

-

-/*

-  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)

-

-  Permission to use, copy, modify, distribute, and sell this 

-  software and its documentation for any purpose is hereby granted

-  without fee, provided that the above copyright notice appear in 

-  all copies and that both that the copyright notice and this

-  permission notice and warranty disclaimer appear in supporting 

-  documentation, and that the name of the author not be used in 

-  advertising or publicity pertaining to distribution of the 

-  software without specific, written prior permission.

-

-  The author disclaim all warranties with regard to this

-  software, including all implied warranties of merchantability

-  and fitness.  In no event shall the author be liable for any

-  special, indirect or consequential damages or any damages

-  whatsoever resulting from loss of use, data or profits, whether

-  in an action of contract, negligence or other tortious action,

-  arising out of or in connection with the use or performance of

-  this software.

-*/

-

-/** \file

- *

- *  Header file for XPROGProtocol.c.

- */

-

-#ifndef _XPROG_PROTOCOL_

-#define _XPROG_PROTOCOL_

-

-	/* Includes: */

-		#include <avr/io.h>

-		#include <util/delay.h>

-		#include <stdio.h>

-		

-		#include <LUFA/Drivers/USB/USB.h>

-		#include <LUFA/Drivers/Peripheral/SerialStream.h>

-	

-		#include "../V2Protocol.h"

-		#include "XPROGTarget.h"

-		#include "XMEGANVM.h"

-		#include "TINYNVM.h"

-

-	/* Preprocessor Checks: */

-		#if ((BOARD == BOARD_XPLAIN) || (BOARD == BOARD_XPLAIN_REV1))

-			#undef ENABLE_ISP_PROTOCOL

-			

-			#if !defined(ENABLE_XPROG_PROTOCOL)

-				#define ENABLE_XPROG_PROTOCOL

-			#endif

-		#endif

-	

-	/* Macros: */

-		#define XPRG_CMD_ENTER_PROGMODE             0x01

-		#define XPRG_CMD_LEAVE_PROGMODE             0x02

-		#define XPRG_CMD_ERASE                      0x03

-		#define XPRG_CMD_WRITE_MEM                  0x04

-		#define XPRG_CMD_READ_MEM                   0x05

-		#define XPRG_CMD_CRC                        0x06

-		#define XPRG_CMD_SET_PARAM                  0x07

-

-		#define XPRG_MEM_TYPE_APPL                  1

-		#define XPRG_MEM_TYPE_BOOT                  2

-		#define XPRG_MEM_TYPE_EEPROM                3

-		#define XPRG_MEM_TYPE_FUSE                  4

-		#define XPRG_MEM_TYPE_LOCKBITS              5

-		#define XPRG_MEM_TYPE_USERSIG               6

-		#define XPRG_MEM_TYPE_FACTORY_CALIBRATION   7

-

-		#define XPRG_ERASE_CHIP                     1

-		#define XPRG_ERASE_APP                      2

-		#define XPRG_ERASE_BOOT                     3

-		#define XPRG_ERASE_EEPROM                   4

-		#define XPRG_ERASE_APP_PAGE                 5

-		#define XPRG_ERASE_BOOT_PAGE                6

-		#define XPRG_ERASE_EEPROM_PAGE              7

-		#define XPRG_ERASE_USERSIG                  8

-

-		#define XPRG_MEM_WRITE_ERASE                0

-		#define XPRG_MEM_WRITE_WRITE                1

-

-		#define XPRG_CRC_APP                        1

-		#define XPRG_CRC_BOOT                       2

-		#define XPRG_CRC_FLASH                      3

-

-		#define XPRG_ERR_OK                         0

-		#define XPRG_ERR_FAILED                     1

-		#define XPRG_ERR_COLLISION                  2

-		#define XPRG_ERR_TIMEOUT                    3

-

-		#define XPRG_PARAM_NVMBASE                  0x01

-		#define XPRG_PARAM_EEPPAGESIZE              0x02

-		#define XPRG_PARAM_NVMCMD_REG               0x03 /* Undocumented, Reverse-engineered */

-		#define XPRG_PARAM_NVMCSR_REG               0x04 /* Undocumented, Reverse-engineered */

-		

-		#define XPRG_PROTOCOL_PDI                   0x00

-		#define XPRG_PROTOCOL_JTAG                  0x01

-		#define XPRG_PROTOCOL_TPI                   0x02 /* Undocumented, Reverse-engineered */

-		

-		#define XPRG_PAGEMODE_WRITE                 (1 << 1)

-		#define XPRG_PAGEMODE_ERASE                 (1 << 0)

-	

-	/* External Variables: */

-		extern uint32_t XPROG_Param_NVMBase;

-		extern uint16_t XPROG_Param_EEPageSize;

-		extern uint8_t  XPROG_Param_NVMCSRRegAddr;

-		extern uint8_t  XPROG_Param_NVMCMDRegAddr;

-		extern uint8_t  XPROG_SelectedProtocol;

-		

-	/* Function Prototypes: */

-		void XPROGProtocol_SetMode(void);

-		void XPROGProtocol_Command(void);

-		

-		#if defined(INCLUDE_FROM_XPROGPROTOCOL_C)

-			static void XPROGProtocol_EnterXPROGMode(void);

-			static void XPROGProtocol_LeaveXPROGMode(void);

-			static void XPROGProtocol_SetParam(void);

-			static void XPROGProtocol_Erase(void);

-			static void XPROGProtocol_WriteMemory(void);

-			static void XPROGProtocol_ReadMemory(void);

-			static void XPROGProtocol_ReadCRC(void);

-		#endif

-		

-#endif

+/*
+             LUFA Library
+     Copyright (C) Dean Camera, 2010.
+              
+  dean [at] fourwalledcubicle [dot] com
+      www.fourwalledcubicle.com
+*/
+
+/*
+  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)
+
+  Permission to use, copy, modify, distribute, and sell this 
+  software and its documentation for any purpose is hereby granted
+  without fee, provided that the above copyright notice appear in 
+  all copies and that both that the copyright notice and this
+  permission notice and warranty disclaimer appear in supporting 
+  documentation, and that the name of the author not be used in 
+  advertising or publicity pertaining to distribution of the 
+  software without specific, written prior permission.
+
+  The author disclaim all warranties with regard to this
+  software, including all implied warranties of merchantability
+  and fitness.  In no event shall the author be liable for any
+  special, indirect or consequential damages or any damages
+  whatsoever resulting from loss of use, data or profits, whether
+  in an action of contract, negligence or other tortious action,
+  arising out of or in connection with the use or performance of
+  this software.
+*/
+
+/** \file
+ *
+ *  Header file for XPROGProtocol.c.
+ */
+
+#ifndef _XPROG_PROTOCOL_
+#define _XPROG_PROTOCOL_
+
+	/* Includes: */
+		#include <avr/io.h>
+		#include <util/delay.h>
+		#include <stdio.h>
+		
+		#include <LUFA/Drivers/USB/USB.h>
+		#include <LUFA/Drivers/Peripheral/SerialStream.h>
+	
+		#include "../V2Protocol.h"
+		#include "XPROGTarget.h"
+		#include "XMEGANVM.h"
+		#include "TINYNVM.h"
+
+	/* Preprocessor Checks: */
+		#if ((BOARD == BOARD_XPLAIN) || (BOARD == BOARD_XPLAIN_REV1))
+			#undef ENABLE_ISP_PROTOCOL
+			
+			#if !defined(ENABLE_XPROG_PROTOCOL)
+				#define ENABLE_XPROG_PROTOCOL
+			#endif
+		#endif
+	
+	/* Macros: */
+		#define XPRG_CMD_ENTER_PROGMODE             0x01
+		#define XPRG_CMD_LEAVE_PROGMODE             0x02
+		#define XPRG_CMD_ERASE                      0x03
+		#define XPRG_CMD_WRITE_MEM                  0x04
+		#define XPRG_CMD_READ_MEM                   0x05
+		#define XPRG_CMD_CRC                        0x06
+		#define XPRG_CMD_SET_PARAM                  0x07
+
+		#define XPRG_MEM_TYPE_APPL                  1
+		#define XPRG_MEM_TYPE_BOOT                  2
+		#define XPRG_MEM_TYPE_EEPROM                3
+		#define XPRG_MEM_TYPE_FUSE                  4
+		#define XPRG_MEM_TYPE_LOCKBITS              5
+		#define XPRG_MEM_TYPE_USERSIG               6
+		#define XPRG_MEM_TYPE_FACTORY_CALIBRATION   7
+
+		#define XPRG_ERASE_CHIP                     1
+		#define XPRG_ERASE_APP                      2
+		#define XPRG_ERASE_BOOT                     3
+		#define XPRG_ERASE_EEPROM                   4
+		#define XPRG_ERASE_APP_PAGE                 5
+		#define XPRG_ERASE_BOOT_PAGE                6
+		#define XPRG_ERASE_EEPROM_PAGE              7
+		#define XPRG_ERASE_USERSIG                  8
+
+		#define XPRG_MEM_WRITE_ERASE                0
+		#define XPRG_MEM_WRITE_WRITE                1
+
+		#define XPRG_CRC_APP                        1
+		#define XPRG_CRC_BOOT                       2
+		#define XPRG_CRC_FLASH                      3
+
+		#define XPRG_ERR_OK                         0
+		#define XPRG_ERR_FAILED                     1
+		#define XPRG_ERR_COLLISION                  2
+		#define XPRG_ERR_TIMEOUT                    3
+
+		#define XPRG_PARAM_NVMBASE                  0x01
+		#define XPRG_PARAM_EEPPAGESIZE              0x02
+		#define XPRG_PARAM_NVMCMD_REG               0x03 /* Undocumented, Reverse-engineered */
+		#define XPRG_PARAM_NVMCSR_REG               0x04 /* Undocumented, Reverse-engineered */
+		
+		#define XPRG_PROTOCOL_PDI                   0x00
+		#define XPRG_PROTOCOL_JTAG                  0x01
+		#define XPRG_PROTOCOL_TPI                   0x02 /* Undocumented, Reverse-engineered */
+		
+		#define XPRG_PAGEMODE_WRITE                 (1 << 1)
+		#define XPRG_PAGEMODE_ERASE                 (1 << 0)
+	
+	/* External Variables: */
+		extern uint32_t XPROG_Param_NVMBase;
+		extern uint16_t XPROG_Param_EEPageSize;
+		extern uint8_t  XPROG_Param_NVMCSRRegAddr;
+		extern uint8_t  XPROG_Param_NVMCMDRegAddr;
+		extern uint8_t  XPROG_SelectedProtocol;
+		
+	/* Function Prototypes: */
+		void XPROGProtocol_SetMode(void);
+		void XPROGProtocol_Command(void);
+		
+		#if defined(INCLUDE_FROM_XPROGPROTOCOL_C)
+			static void XPROGProtocol_EnterXPROGMode(void);
+			static void XPROGProtocol_LeaveXPROGMode(void);
+			static void XPROGProtocol_SetParam(void);
+			static void XPROGProtocol_Erase(void);
+			static void XPROGProtocol_WriteMemory(void);
+			static void XPROGProtocol_ReadMemory(void);
+			static void XPROGProtocol_ReadCRC(void);
+		#endif
+		
+#endif
diff --git a/Projects/AVRISP-MKII/Lib/XPROG/XPROGTarget.c b/Projects/AVRISP-MKII/Lib/XPROG/XPROGTarget.c
index 72a38f824..5598791a6 100644
--- a/Projects/AVRISP-MKII/Lib/XPROG/XPROGTarget.c
+++ b/Projects/AVRISP-MKII/Lib/XPROG/XPROGTarget.c
@@ -1,221 +1,221 @@
-/*

-             LUFA Library

-     Copyright (C) Dean Camera, 2010.

-              

-  dean [at] fourwalledcubicle [dot] com

-      www.fourwalledcubicle.com

-*/

-

-/*

-  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)

-

-  Permission to use, copy, modify, distribute, and sell this 

-  software and its documentation for any purpose is hereby granted

-  without fee, provided that the above copyright notice appear in 

-  all copies and that both that the copyright notice and this

-  permission notice and warranty disclaimer appear in supporting 

-  documentation, and that the name of the author not be used in 

-  advertising or publicity pertaining to distribution of the 

-  software without specific, written prior permission.

-

-  The author disclaim all warranties with regard to this

-  software, including all implied warranties of merchantability

-  and fitness.  In no event shall the author be liable for any

-  special, indirect or consequential damages or any damages

-  whatsoever resulting from loss of use, data or profits, whether

-  in an action of contract, negligence or other tortious action,

-  arising out of or in connection with the use or performance of

-  this software.

-*/

-

-/** \file

- *

- *  Target-related functions for the PDI Protocol decoder.

- */

-

-#define  INCLUDE_FROM_XPROGTARGET_C

-#include "XPROGTarget.h"

-

-#if defined(ENABLE_XPROG_PROTOCOL) || defined(__DOXYGEN__)

-

-/** Flag to indicate if the USART is currently in Tx or Rx mode. */

-volatile bool IsSending;

-

-/** Enables the target's PDI interface, holding the target in reset until PDI mode is exited. */

-void XPROGTarget_EnableTargetPDI(void)

-{

-	IsSending = false;

-

-	/* Set Tx and XCK as outputs, Rx as input */

-	DDRD |=  (1 << 5) | (1 << 3);

-	DDRD &= ~(1 << 2);

-	

-	/* Set DATA line high for at least 90ns to disable /RESET functionality */

-	PORTD |= (1 << 3);

-	_delay_us(1);

-	

-	/* Set up the synchronous USART for XMEGA communications - 8 data bits, even parity, 2 stop bits */

-	UBRR1  = (F_CPU / XPROG_HARDWARE_SPEED);

-	UCSR1B = (1 << TXEN1);

-	UCSR1C = (1 << UMSEL10) | (1 << UPM11) | (1 << USBS1) | (1 << UCSZ11) | (1 << UCSZ10) | (1 << UCPOL1);

-

-	/* Send two BREAKs of 12 bits each to enable PDI interface (need at least 16 idle bits) */

-	XPROGTarget_SendBreak();

-	XPROGTarget_SendBreak();

-}

-

-/** Enables the target's TPI interface, holding the target in reset until TPI mode is exited. */

-void XPROGTarget_EnableTargetTPI(void)

-{

-	IsSending = false;

-

-	/* Set /RESET line low for at least 400ns to enable TPI functionality */

-	AUX_LINE_DDR  |=  AUX_LINE_MASK;

-	AUX_LINE_PORT &= ~AUX_LINE_MASK;

-	_delay_us(1);

-

-	/* Set Tx and XCK as outputs, Rx as input */

-	DDRD |=  (1 << 5) | (1 << 3);

-	DDRD &= ~(1 << 2);

-		

-	/* Set up the synchronous USART for TINY communications - 8 data bits, even parity, 2 stop bits */

-	UBRR1  = (F_CPU / XPROG_HARDWARE_SPEED);

-	UCSR1B = (1 << TXEN1);

-	UCSR1C = (1 << UMSEL10) | (1 << UPM11) | (1 << USBS1) | (1 << UCSZ11) | (1 << UCSZ10) | (1 << UCPOL1);

-

-	/* Send two BREAKs of 12 bits each to enable TPI interface (need at least 16 idle bits) */

-	XPROGTarget_SendBreak();

-	XPROGTarget_SendBreak();

-}

-

-/** Disables the target's PDI interface, exits programming mode and starts the target's application. */

-void XPROGTarget_DisableTargetPDI(void)

-{

-	/* Switch to Rx mode to ensure that all pending transmissions are complete */

-	XPROGTarget_SetRxMode();

-

-	/* Turn off receiver and transmitter of the USART, clear settings */

-	UCSR1A  = ((1 << TXC1) | (1 << RXC1));

-	UCSR1B  = 0;

-	UCSR1C  = 0;

-

-	/* Tristate all pins */

-	DDRD  &= ~((1 << 5) | (1 << 3));

-	PORTD &= ~((1 << 5) | (1 << 3) | (1 << 2));

-}

-

-/** Disables the target's TPI interface, exits programming mode and starts the target's application. */

-void XPROGTarget_DisableTargetTPI(void)

-{

-	/* Switch to Rx mode to ensure that all pending transmissions are complete */

-	XPROGTarget_SetRxMode();

-

-	/* Turn off receiver and transmitter of the USART, clear settings */

-	UCSR1A |= (1 << TXC1) | (1 << RXC1);

-	UCSR1B  = 0;

-	UCSR1C  = 0;

-

-	/* Set all USART lines as input, tristate */

-	DDRD  &= ~((1 << 5) | (1 << 3));

-	PORTD &= ~((1 << 5) | (1 << 3) | (1 << 2));

-

-	/* Tristate target /RESET line */

-	AUX_LINE_DDR  &= ~AUX_LINE_MASK;

-	AUX_LINE_PORT &= ~AUX_LINE_MASK;

-}

-

-/** Sends a byte via the USART.

- *

- *  \param[in] Byte  Byte to send through the USART

- */

-void XPROGTarget_SendByte(const uint8_t Byte)

-{

-	/* Switch to Tx mode if currently in Rx mode */

-	if (!(IsSending))

-	  XPROGTarget_SetTxMode();

-	  

-	/* Wait until there is space in the hardware Tx buffer before writing */

-	while (!(UCSR1A & (1 << UDRE1)));

-	UCSR1A |= (1 << TXC1);

-	UDR1    = Byte;

-

-    if (TimeoutMSRemaining)

-	  TimeoutMSRemaining = COMMAND_TIMEOUT_MS;

-}

-

-/** Receives a byte via the software USART, blocking until data is received.

- *

- *  \return Received byte from the USART

- */

-uint8_t XPROGTarget_ReceiveByte(void)

-{

-	/* Switch to Rx mode if currently in Tx mode */

-	if (IsSending)

-	  XPROGTarget_SetRxMode();

-

-	/* Wait until a byte has been received before reading */

-	while (!(UCSR1A & (1 << RXC1)) && TimeoutMSRemaining);

-	

-	if (TimeoutMSRemaining)

-	  TimeoutMSRemaining = COMMAND_TIMEOUT_MS;

-

-	return UDR1;

-}

-

-/** Sends a BREAK via the USART to the attached target, consisting of a full frame of idle bits. */

-void XPROGTarget_SendBreak(void)

-{

-	/* Switch to Tx mode if currently in Rx mode */

-	if (!(IsSending))

-	  XPROGTarget_SetTxMode();

-

-	/* Need to do nothing for a full frame to send a BREAK */

-	for (uint8_t i = 0; i < BITS_IN_USART_FRAME; i++)

-	{

-		/* Wait for a full cycle of the clock */

-		while (PIND & (1 << 5));

-		while (!(PIND & (1 << 5)));

-	}

-

-    if (TimeoutMSRemaining)

-	  TimeoutMSRemaining = COMMAND_TIMEOUT_MS;

-}

-

-static void XPROGTarget_SetTxMode(void)

-{

-	/* Wait for a full cycle of the clock */

-	while (PIND & (1 << 5));

-	while (!(PIND & (1 << 5)));

-

-	PORTD  |=  (1 << 3);

-	DDRD   |=  (1 << 3);

-

-	UCSR1B &= ~(1 << RXEN1);

-	UCSR1B |=  (1 << TXEN1);

-		

-	IsSending = true;

-

-    if (TimeoutMSRemaining)

-	  TimeoutMSRemaining = COMMAND_TIMEOUT_MS;

-

-	IsSending = true;

-}

-

-static void XPROGTarget_SetRxMode(void)

-{

-	while (!(UCSR1A & (1 << TXC1)));

-	UCSR1A |=  (1 << TXC1);

-

-	UCSR1B &= ~(1 << TXEN1);

-	UCSR1B |=  (1 << RXEN1);

-

-	DDRD   &= ~(1 << 3);

-	PORTD  &= ~(1 << 3);

-

-    if (TimeoutMSRemaining)

-	  TimeoutMSRemaining = COMMAND_TIMEOUT_MS;

-

-	IsSending = false;

-}

-

-#endif

+/*
+             LUFA Library
+     Copyright (C) Dean Camera, 2010.
+              
+  dean [at] fourwalledcubicle [dot] com
+      www.fourwalledcubicle.com
+*/
+
+/*
+  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)
+
+  Permission to use, copy, modify, distribute, and sell this 
+  software and its documentation for any purpose is hereby granted
+  without fee, provided that the above copyright notice appear in 
+  all copies and that both that the copyright notice and this
+  permission notice and warranty disclaimer appear in supporting 
+  documentation, and that the name of the author not be used in 
+  advertising or publicity pertaining to distribution of the 
+  software without specific, written prior permission.
+
+  The author disclaim all warranties with regard to this
+  software, including all implied warranties of merchantability
+  and fitness.  In no event shall the author be liable for any
+  special, indirect or consequential damages or any damages
+  whatsoever resulting from loss of use, data or profits, whether
+  in an action of contract, negligence or other tortious action,
+  arising out of or in connection with the use or performance of
+  this software.
+*/
+
+/** \file
+ *
+ *  Target-related functions for the PDI Protocol decoder.
+ */
+
+#define  INCLUDE_FROM_XPROGTARGET_C
+#include "XPROGTarget.h"
+
+#if defined(ENABLE_XPROG_PROTOCOL) || defined(__DOXYGEN__)
+
+/** Flag to indicate if the USART is currently in Tx or Rx mode. */
+volatile bool IsSending;
+
+/** Enables the target's PDI interface, holding the target in reset until PDI mode is exited. */
+void XPROGTarget_EnableTargetPDI(void)
+{
+	IsSending = false;
+
+	/* Set Tx and XCK as outputs, Rx as input */
+	DDRD |=  (1 << 5) | (1 << 3);
+	DDRD &= ~(1 << 2);
+	
+	/* Set DATA line high for at least 90ns to disable /RESET functionality */
+	PORTD |= (1 << 3);
+	_delay_us(1);
+	
+	/* Set up the synchronous USART for XMEGA communications - 8 data bits, even parity, 2 stop bits */
+	UBRR1  = (F_CPU / XPROG_HARDWARE_SPEED);
+	UCSR1B = (1 << TXEN1);
+	UCSR1C = (1 << UMSEL10) | (1 << UPM11) | (1 << USBS1) | (1 << UCSZ11) | (1 << UCSZ10) | (1 << UCPOL1);
+
+	/* Send two BREAKs of 12 bits each to enable PDI interface (need at least 16 idle bits) */
+	XPROGTarget_SendBreak();
+	XPROGTarget_SendBreak();
+}
+
+/** Enables the target's TPI interface, holding the target in reset until TPI mode is exited. */
+void XPROGTarget_EnableTargetTPI(void)
+{
+	IsSending = false;
+
+	/* Set /RESET line low for at least 400ns to enable TPI functionality */
+	AUX_LINE_DDR  |=  AUX_LINE_MASK;
+	AUX_LINE_PORT &= ~AUX_LINE_MASK;
+	_delay_us(1);
+
+	/* Set Tx and XCK as outputs, Rx as input */
+	DDRD |=  (1 << 5) | (1 << 3);
+	DDRD &= ~(1 << 2);
+		
+	/* Set up the synchronous USART for TINY communications - 8 data bits, even parity, 2 stop bits */
+	UBRR1  = (F_CPU / XPROG_HARDWARE_SPEED);
+	UCSR1B = (1 << TXEN1);
+	UCSR1C = (1 << UMSEL10) | (1 << UPM11) | (1 << USBS1) | (1 << UCSZ11) | (1 << UCSZ10) | (1 << UCPOL1);
+
+	/* Send two BREAKs of 12 bits each to enable TPI interface (need at least 16 idle bits) */
+	XPROGTarget_SendBreak();
+	XPROGTarget_SendBreak();
+}
+
+/** Disables the target's PDI interface, exits programming mode and starts the target's application. */
+void XPROGTarget_DisableTargetPDI(void)
+{
+	/* Switch to Rx mode to ensure that all pending transmissions are complete */
+	XPROGTarget_SetRxMode();
+
+	/* Turn off receiver and transmitter of the USART, clear settings */
+	UCSR1A  = ((1 << TXC1) | (1 << RXC1));
+	UCSR1B  = 0;
+	UCSR1C  = 0;
+
+	/* Tristate all pins */
+	DDRD  &= ~((1 << 5) | (1 << 3));
+	PORTD &= ~((1 << 5) | (1 << 3) | (1 << 2));
+}
+
+/** Disables the target's TPI interface, exits programming mode and starts the target's application. */
+void XPROGTarget_DisableTargetTPI(void)
+{
+	/* Switch to Rx mode to ensure that all pending transmissions are complete */
+	XPROGTarget_SetRxMode();
+
+	/* Turn off receiver and transmitter of the USART, clear settings */
+	UCSR1A |= (1 << TXC1) | (1 << RXC1);
+	UCSR1B  = 0;
+	UCSR1C  = 0;
+
+	/* Set all USART lines as input, tristate */
+	DDRD  &= ~((1 << 5) | (1 << 3));
+	PORTD &= ~((1 << 5) | (1 << 3) | (1 << 2));
+
+	/* Tristate target /RESET line */
+	AUX_LINE_DDR  &= ~AUX_LINE_MASK;
+	AUX_LINE_PORT &= ~AUX_LINE_MASK;
+}
+
+/** Sends a byte via the USART.
+ *
+ *  \param[in] Byte  Byte to send through the USART
+ */
+void XPROGTarget_SendByte(const uint8_t Byte)
+{
+	/* Switch to Tx mode if currently in Rx mode */
+	if (!(IsSending))
+	  XPROGTarget_SetTxMode();
+	  
+	/* Wait until there is space in the hardware Tx buffer before writing */
+	while (!(UCSR1A & (1 << UDRE1)));
+	UCSR1A |= (1 << TXC1);
+	UDR1    = Byte;
+
+    if (TimeoutMSRemaining)
+	  TimeoutMSRemaining = COMMAND_TIMEOUT_MS;
+}
+
+/** Receives a byte via the software USART, blocking until data is received.
+ *
+ *  \return Received byte from the USART
+ */
+uint8_t XPROGTarget_ReceiveByte(void)
+{
+	/* Switch to Rx mode if currently in Tx mode */
+	if (IsSending)
+	  XPROGTarget_SetRxMode();
+
+	/* Wait until a byte has been received before reading */
+	while (!(UCSR1A & (1 << RXC1)) && TimeoutMSRemaining);
+	
+	if (TimeoutMSRemaining)
+	  TimeoutMSRemaining = COMMAND_TIMEOUT_MS;
+
+	return UDR1;
+}
+
+/** Sends a BREAK via the USART to the attached target, consisting of a full frame of idle bits. */
+void XPROGTarget_SendBreak(void)
+{
+	/* Switch to Tx mode if currently in Rx mode */
+	if (!(IsSending))
+	  XPROGTarget_SetTxMode();
+
+	/* Need to do nothing for a full frame to send a BREAK */
+	for (uint8_t i = 0; i < BITS_IN_USART_FRAME; i++)
+	{
+		/* Wait for a full cycle of the clock */
+		while (PIND & (1 << 5));
+		while (!(PIND & (1 << 5)));
+	}
+
+    if (TimeoutMSRemaining)
+	  TimeoutMSRemaining = COMMAND_TIMEOUT_MS;
+}
+
+static void XPROGTarget_SetTxMode(void)
+{
+	/* Wait for a full cycle of the clock */
+	while (PIND & (1 << 5));
+	while (!(PIND & (1 << 5)));
+
+	PORTD  |=  (1 << 3);
+	DDRD   |=  (1 << 3);
+
+	UCSR1B &= ~(1 << RXEN1);
+	UCSR1B |=  (1 << TXEN1);
+		
+	IsSending = true;
+
+    if (TimeoutMSRemaining)
+	  TimeoutMSRemaining = COMMAND_TIMEOUT_MS;
+
+	IsSending = true;
+}
+
+static void XPROGTarget_SetRxMode(void)
+{
+	while (!(UCSR1A & (1 << TXC1)));
+	UCSR1A |=  (1 << TXC1);
+
+	UCSR1B &= ~(1 << TXEN1);
+	UCSR1B |=  (1 << RXEN1);
+
+	DDRD   &= ~(1 << 3);
+	PORTD  &= ~(1 << 3);
+
+    if (TimeoutMSRemaining)
+	  TimeoutMSRemaining = COMMAND_TIMEOUT_MS;
+
+	IsSending = false;
+}
+
+#endif
diff --git a/Projects/AVRISP-MKII/Lib/XPROG/XPROGTarget.h b/Projects/AVRISP-MKII/Lib/XPROG/XPROGTarget.h
index 65ec11bcf..436f0f30d 100644
--- a/Projects/AVRISP-MKII/Lib/XPROG/XPROGTarget.h
+++ b/Projects/AVRISP-MKII/Lib/XPROG/XPROGTarget.h
@@ -1,126 +1,126 @@
-/*

-             LUFA Library

-     Copyright (C) Dean Camera, 2010.

-              

-  dean [at] fourwalledcubicle [dot] com

-      www.fourwalledcubicle.com

-*/

-

-/*

-  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)

-

-  Permission to use, copy, modify, distribute, and sell this 

-  software and its documentation for any purpose is hereby granted

-  without fee, provided that the above copyright notice appear in 

-  all copies and that both that the copyright notice and this

-  permission notice and warranty disclaimer appear in supporting 

-  documentation, and that the name of the author not be used in 

-  advertising or publicity pertaining to distribution of the 

-  software without specific, written prior permission.

-

-  The author disclaim all warranties with regard to this

-  software, including all implied warranties of merchantability

-  and fitness.  In no event shall the author be liable for any

-  special, indirect or consequential damages or any damages

-  whatsoever resulting from loss of use, data or profits, whether

-  in an action of contract, negligence or other tortious action,

-  arising out of or in connection with the use or performance of

-  this software.

-*/

-

-/** \file

- *

- *  Header file for XPROGTarget.c.

- */

-

-#ifndef _XPROG_TARGET_

-#define _XPROG_TARGET_

-

-	/* Includes: */

-		#include <avr/io.h>

-		#include <avr/interrupt.h>

-		#include <stdbool.h>

-		

-		#include <LUFA/Common/Common.h>

-		

-		#include "../V2Protocol.h"

-		#include "XPROGProtocol.h"

-	

-	/* Preprocessor Checks: */

-		#if ((BOARD == BOARD_XPLAIN) || (BOARD == BOARD_XPLAIN_REV1))

-			#undef ENABLE_ISP_PROTOCOL

-			

-			#if !defined(ENABLE_XPROG_PROTOCOL)

-				#define ENABLE_XPROG_PROTOCOL

-			#endif

-		#endif

-		

-		/** Serial carrier TPI/PDI speed when hardware TPI/PDI mode is used */

-		#define XPROG_HARDWARE_SPEED       1000000

-

-		/** Total number of bits in a single USART frame */

-		#define BITS_IN_USART_FRAME        12

-		

-		#define PDI_CMD_LDS                0x00

-		#define PDI_CMD_LD                 0x20

-		#define PDI_CMD_STS                0x40

-		#define PDI_CMD_ST                 0x60

-		#define PDI_CMD_LDCS               0x80

-		#define PDI_CMD_REPEAT             0xA0

-		#define PDI_CMD_STCS               0xC0

-		#define PDI_CMD_KEY                0xE0

-		

-		#define PDI_STATUS_REG             0

-		#define PDI_RESET_REG              1

-		#define PDI_CTRL_REG               2

-		

-		#define PDI_STATUS_NVM             (1 << 1)

-

-		#define PDI_RESET_KEY              0x59

-		#define PDI_NVMENABLE_KEY          (uint8_t[]){0x12, 0x89, 0xAB, 0x45, 0xCD, 0xD8, 0x88, 0xFF}

-

-		#define PDI_DATSIZE_1BYTE          0

-		#define PDI_DATSIZE_2BYTES         1

-		#define PDI_DATSIZE_3BYTES         2

-		#define PDI_DATSIZE_4BYTES         3

-		

-		#define PDI_POINTER_INDIRECT       0

-		#define PDI_POINTER_INDIRECT_PI    1

-		#define PDI_POINTER_DIRECT         2

-

-		#define TPI_CMD_SLD                0x20

-		#define TPI_CMD_SST                0x60

-		#define TPI_CMD_SSTPR              0x68

-		#define TPI_CMD_SIN                0x10

-		#define TPI_CMD_SOUT               0x90

-		#define TPI_CMD_SLDCS              0x80

-		#define TPI_CMD_SSTCS              0xC0

-		#define TPI_CMD_SKEY               0xE0

-

-		#define TPI_STATUS_REG             0x00

-		#define TPI_CTRL_REG               0x02

-		#define TPI_ID_REG                 0x0F

-		

-		#define TPI_STATUS_NVM             (1 << 1)

-

-		#define TPI_NVMENABLE_KEY          (uint8_t[]){0x12, 0x89, 0xAB, 0x45, 0xCD, 0xD8, 0x88, 0xFF}

-

-		#define TPI_POINTER_INDIRECT       0

-		#define TPI_POINTER_INDIRECT_PI    4

-		

-	/* Function Prototypes: */

-		void    XPROGTarget_EnableTargetPDI(void);

-		void    XPROGTarget_EnableTargetTPI(void);

-		void    XPROGTarget_DisableTargetPDI(void);

-		void    XPROGTarget_DisableTargetTPI(void);

-		void    XPROGTarget_SendByte(const uint8_t Byte);

-		uint8_t XPROGTarget_ReceiveByte(void);

-		void    XPROGTarget_SendBreak(void);

-		bool    XPROGTarget_WaitWhileNVMBusBusy(void);

-		

-		#if defined(INCLUDE_FROM_XPROGTARGET_C)

-			static void XPROGTarget_SetTxMode(void);

-			static void XPROGTarget_SetRxMode(void);

-		#endif

-

-#endif

+/*
+             LUFA Library
+     Copyright (C) Dean Camera, 2010.
+              
+  dean [at] fourwalledcubicle [dot] com
+      www.fourwalledcubicle.com
+*/
+
+/*
+  Copyright 2010  Dean Camera (dean [at] fourwalledcubicle [dot] com)
+
+  Permission to use, copy, modify, distribute, and sell this 
+  software and its documentation for any purpose is hereby granted
+  without fee, provided that the above copyright notice appear in 
+  all copies and that both that the copyright notice and this
+  permission notice and warranty disclaimer appear in supporting 
+  documentation, and that the name of the author not be used in 
+  advertising or publicity pertaining to distribution of the 
+  software without specific, written prior permission.
+
+  The author disclaim all warranties with regard to this
+  software, including all implied warranties of merchantability
+  and fitness.  In no event shall the author be liable for any
+  special, indirect or consequential damages or any damages
+  whatsoever resulting from loss of use, data or profits, whether
+  in an action of contract, negligence or other tortious action,
+  arising out of or in connection with the use or performance of
+  this software.
+*/
+
+/** \file
+ *
+ *  Header file for XPROGTarget.c.
+ */
+
+#ifndef _XPROG_TARGET_
+#define _XPROG_TARGET_
+
+	/* Includes: */
+		#include <avr/io.h>
+		#include <avr/interrupt.h>
+		#include <stdbool.h>
+		
+		#include <LUFA/Common/Common.h>
+		
+		#include "../V2Protocol.h"
+		#include "XPROGProtocol.h"
+	
+	/* Preprocessor Checks: */
+		#if ((BOARD == BOARD_XPLAIN) || (BOARD == BOARD_XPLAIN_REV1))
+			#undef ENABLE_ISP_PROTOCOL
+			
+			#if !defined(ENABLE_XPROG_PROTOCOL)
+				#define ENABLE_XPROG_PROTOCOL
+			#endif
+		#endif
+		
+		/** Serial carrier TPI/PDI speed when hardware TPI/PDI mode is used */
+		#define XPROG_HARDWARE_SPEED       1000000
+
+		/** Total number of bits in a single USART frame */
+		#define BITS_IN_USART_FRAME        12
+		
+		#define PDI_CMD_LDS                0x00
+		#define PDI_CMD_LD                 0x20
+		#define PDI_CMD_STS                0x40
+		#define PDI_CMD_ST                 0x60
+		#define PDI_CMD_LDCS               0x80
+		#define PDI_CMD_REPEAT             0xA0
+		#define PDI_CMD_STCS               0xC0
+		#define PDI_CMD_KEY                0xE0
+		
+		#define PDI_STATUS_REG             0
+		#define PDI_RESET_REG              1
+		#define PDI_CTRL_REG               2
+		
+		#define PDI_STATUS_NVM             (1 << 1)
+
+		#define PDI_RESET_KEY              0x59
+		#define PDI_NVMENABLE_KEY          (uint8_t[]){0x12, 0x89, 0xAB, 0x45, 0xCD, 0xD8, 0x88, 0xFF}
+
+		#define PDI_DATSIZE_1BYTE          0
+		#define PDI_DATSIZE_2BYTES         1
+		#define PDI_DATSIZE_3BYTES         2
+		#define PDI_DATSIZE_4BYTES         3
+		
+		#define PDI_POINTER_INDIRECT       0
+		#define PDI_POINTER_INDIRECT_PI    1
+		#define PDI_POINTER_DIRECT         2
+
+		#define TPI_CMD_SLD                0x20
+		#define TPI_CMD_SST                0x60
+		#define TPI_CMD_SSTPR              0x68
+		#define TPI_CMD_SIN                0x10
+		#define TPI_CMD_SOUT               0x90
+		#define TPI_CMD_SLDCS              0x80
+		#define TPI_CMD_SSTCS              0xC0
+		#define TPI_CMD_SKEY               0xE0
+
+		#define TPI_STATUS_REG             0x00
+		#define TPI_CTRL_REG               0x02
+		#define TPI_ID_REG                 0x0F
+		
+		#define TPI_STATUS_NVM             (1 << 1)
+
+		#define TPI_NVMENABLE_KEY          (uint8_t[]){0x12, 0x89, 0xAB, 0x45, 0xCD, 0xD8, 0x88, 0xFF}
+
+		#define TPI_POINTER_INDIRECT       0
+		#define TPI_POINTER_INDIRECT_PI    4
+		
+	/* Function Prototypes: */
+		void    XPROGTarget_EnableTargetPDI(void);
+		void    XPROGTarget_EnableTargetTPI(void);
+		void    XPROGTarget_DisableTargetPDI(void);
+		void    XPROGTarget_DisableTargetTPI(void);
+		void    XPROGTarget_SendByte(const uint8_t Byte);
+		uint8_t XPROGTarget_ReceiveByte(void);
+		void    XPROGTarget_SendBreak(void);
+		bool    XPROGTarget_WaitWhileNVMBusBusy(void);
+		
+		#if defined(INCLUDE_FROM_XPROGTARGET_C)
+			static void XPROGTarget_SetTxMode(void);
+			static void XPROGTarget_SetRxMode(void);
+		#endif
+
+#endif