From f69f03cb0d02937dee018264f0ac4e9be76fc1f4 Mon Sep 17 00:00:00 2001
From: Dean Camera <dean@fourwalledcubicle.com>
Date: Thu, 3 Dec 2009 00:53:45 +0000
Subject: Started implementing the low level PDI protocol in the AVRISP
 project, for XMEGA device programming.

---
 Projects/AVRISP/Lib/PDIProtocol.c | 83 +++++++++++++++++++++++++--------------
 1 file changed, 54 insertions(+), 29 deletions(-)

(limited to 'Projects/AVRISP/Lib/PDIProtocol.c')

diff --git a/Projects/AVRISP/Lib/PDIProtocol.c b/Projects/AVRISP/Lib/PDIProtocol.c
index b095a49c5..c91956143 100644
--- a/Projects/AVRISP/Lib/PDIProtocol.c
+++ b/Projects/AVRISP/Lib/PDIProtocol.c
@@ -35,7 +35,7 @@
  *  PDI Protocol handler, to process V2 Protocol wrapped PDI commands used in Atmel programmer devices.
  */
 
-#define  INCLUDE_FROM_XPROG_C
+#define  INCLUDE_FROM_PDIPROTOCOL_C
 #include "PDIProtocol.h"
 
 uint32_t XPROG_Param_NVMBase;
@@ -91,6 +91,59 @@ void PDIProtocol_XPROG_Command(void)
 	}
 }
 
+static void PDIProtocol_EnterXPROGMode(void)
+{
+	uint8_t ReturnStatus = XPRG_ERR_OK;
+
+	Endpoint_ClearOUT();
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+	
+	PDIDATA_LINE_DDR  |= PDIDATA_LINE_MASK;
+	PDICLOCK_LINE_DDR |= PDICLOCK_LINE_MASK;
+	
+	PDIDATA_LINE_PORT |= PDIDATA_LINE_MASK;
+
+	_delay_us(1);
+	
+	for (uint8_t i = 0; i < 16; i++)
+	{
+		PDICLOCK_LINE_PORT ^= PDICLOCK_LINE_MASK;
+		PDICLOCK_LINE_PORT ^= PDICLOCK_LINE_MASK;
+	}
+		
+	static const uint8_t NVMKey[8] = {0x12, 0x89, 0xAB, 0x45, 0xCD, 0xD8, 0x88, 0xFF};
+	
+	PDITarget_SendByte(PDI_CMD_KEY);	
+	for (uint8_t i = 0; i < 8; i++)
+	  PDITarget_SendByte(NVMKey[i]);
+
+	PDITarget_SendByte(PDI_CMD_LDCS | PD_STATUS_REG);	
+	if (!(PDITarget_ReceiveByte() & PDI_STATUS_NVM))
+	  ReturnStatus = XPRG_ERR_FAILED;
+	
+	Endpoint_Write_Byte(CMD_XPROG);
+	Endpoint_Write_Byte(XPRG_CMD_ENTER_PROGMODE);
+	Endpoint_Write_Byte(ReturnStatus);
+	Endpoint_ClearIN();
+}
+
+static void PDIProtocol_LeaveXPROGMode(void)
+{
+	Endpoint_ClearOUT();
+	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+	
+	PDIDATA_LINE_DDR   &= ~PDIDATA_LINE_MASK;
+	PDICLOCK_LINE_DDR  &= ~PDICLOCK_LINE_MASK;
+
+	PDIDATA_LINE_PORT  &= ~PDIDATA_LINE_MASK;
+	PDICLOCK_LINE_PORT &= ~PDICLOCK_LINE_MASK;
+	
+	Endpoint_Write_Byte(CMD_XPROG);
+	Endpoint_Write_Byte(XPRG_CMD_LEAVE_PROGMODE);
+	Endpoint_Write_Byte(XPRG_ERR_OK);
+	Endpoint_ClearIN();
+}
+
 static void PDIProtocol_EraseChip(void)
 {
 	uint8_t ReturnStatus = XPRG_ERR_OK;
@@ -209,34 +262,6 @@ static void PDIProtocol_ReadCRC(void)
 	Endpoint_ClearIN();	
 }
 
-static void PDIProtocol_EnterXPROGMode(void)
-{
-	uint8_t ReturnStatus = XPRG_ERR_OK;
-
-	Endpoint_ClearOUT();
-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
-	
-	// TODO: Enter device programming mode here via PDI protocol
-	
-	Endpoint_Write_Byte(CMD_XPROG);
-	Endpoint_Write_Byte(XPRG_CMD_ENTER_PROGMODE);
-	Endpoint_Write_Byte(ReturnStatus);
-	Endpoint_ClearIN();
-}
-
-static void PDIProtocol_LeaveXPROGMode(void)
-{
-	Endpoint_ClearOUT();
-	Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
-	
-	// TODO: Exit device programming mode here via PDI protocol
-
-	Endpoint_Write_Byte(CMD_XPROG);
-	Endpoint_Write_Byte(XPRG_CMD_LEAVE_PROGMODE);
-	Endpoint_Write_Byte(XPRG_ERR_OK);
-	Endpoint_ClearIN();
-}
-
 static void PDIProtocol_SetParam(void)
 {
 	uint8_t ReturnStatus = XPRG_ERR_OK;
-- 
cgit v1.2.3