diff options
Diffstat (limited to 'Projects/Unfinished/AVRISP/Lib/V2Protocol.c')
| -rw-r--r-- | Projects/Unfinished/AVRISP/Lib/V2Protocol.c | 79 |
1 files changed, 75 insertions, 4 deletions
diff --git a/Projects/Unfinished/AVRISP/Lib/V2Protocol.c b/Projects/Unfinished/AVRISP/Lib/V2Protocol.c index 2679ce7f7..27f6fa7dc 100644 --- a/Projects/Unfinished/AVRISP/Lib/V2Protocol.c +++ b/Projects/Unfinished/AVRISP/Lib/V2Protocol.c @@ -59,6 +59,24 @@ ParameterItem_t ParameterTable[] EEMEM = { .ParameterID = PARAM_DISCHARGEDELAY,
.ParameterValue = 0x00 },
};
+
+void V2Protocol_ConfigureHardware(void)
+{
+#if F_CPU == 8000000
+ uint8_t SPIMaskFromSCKDuration[] = {SPI_SPEED_FCPU_DIV_128, SPI_SPEED_FCPU_DIV_128, SPI_SPEED_FCPU_DIV_128,
+ SPI_SPEED_FCPU_DIV_128, SPI_SPEED_FCPU_DIV_128, SPI_SPEED_FCPU_DIV_128};
+#else
+ uint8_t SPIMaskFromSCKDuration[] = {SPI_SPEED_FCPU_DIV_128, SPI_SPEED_FCPU_DIV_128, SPI_SPEED_FCPU_DIV_128,
+ SPI_SPEED_FCPU_DIV_128, SPI_SPEED_FCPU_DIV_128, SPI_SPEED_FCPU_DIV_128};
+#endif
+
+ uint8_t SCKDuration = eeprom_read_byte(&V2Protocol_GetParameterItem(PARAM_SCK_DURATION)->ParameterValue);
+
+ if (SCKDuration > sizeof(SPIMaskFromSCKDuration))
+ SCKDuration = SPIMaskFromSCKDuration;
+
+ SPI_Init(SPIMaskFromSCKDuration[SCKDuration], true);
+}
void V2Protocol_ProcessCommand(void) { @@ -73,6 +91,9 @@ void V2Protocol_ProcessCommand(void) case CMD_GET_PARAMETER:
V2Protocol_ProcessCmdGetSetParam(V2Command);
break;
+ case CMD_SPI_MULTI:
+ V2Protocol_ProcessCmdSPIMulti();
+ break;
default:
while (Endpoint_BytesInEndpoint() == AVRISP_DATA_EPSIZE)
{
@@ -83,6 +104,7 @@ void V2Protocol_ProcessCommand(void) Endpoint_ClearOUT();
Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+ Endpoint_Write_Byte(V2Command);
Endpoint_Write_Byte(STATUS_CMD_UNKNOWN);
Endpoint_ClearIN();
break;
@@ -90,9 +112,7 @@ void V2Protocol_ProcessCommand(void) printf("COMMAND 0x%02x\r\n", V2Command);
- Endpoint_WaitUntilReady();
-
- /* Reset Endpoint direction to OUT ready for next command */
+ Endpoint_WaitUntilReady();
Endpoint_SetEndpointDirection(ENDPOINT_DIR_OUT); }
@@ -113,6 +133,8 @@ static void V2Protocol_ProcessCmdSignOn(void) Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
Endpoint_WaitUntilReady();
+ V2Protocol_ConfigureHardware();
+
Endpoint_Write_Byte(CMD_SIGN_ON);
Endpoint_Write_Byte(STATUS_CMD_OK);
Endpoint_Write_Byte(PROGRAMMER_ID_LEN);
@@ -131,9 +153,10 @@ static void V2Protocol_ProcessCmdGetSetParam(uint8_t V2Command) ParameterItem_t* ParameterItem = V2Protocol_GetParameterItem(ParamID);
+ Endpoint_Write_Byte(V2Command);
+
if (ParameterItem != NULL)
{
- Endpoint_Write_Byte(V2Command);
Endpoint_Write_Byte(STATUS_CMD_OK);
if (V2Command == CMD_SET_PARAMETER)
@@ -148,3 +171,51 @@ static void V2Protocol_ProcessCmdGetSetParam(uint8_t V2Command) Endpoint_ClearIN();
}
+
+static void V2Protocol_ProcessCmdSPIMulti(void)
+{
+ uint8_t TxBytes = Endpoint_Read_Byte();
+ uint8_t RxBytes = Endpoint_Read_Byte();
+ uint8_t RxStartAddr = Endpoint_Read_Byte();
+ uint8_t TxData[255];
+
+ Endpoint_Read_Stream_LE(TxData, TxBytes);
+
+ Endpoint_ClearOUT();
+ Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN);
+ Endpoint_WaitUntilReady();
+
+ Endpoint_Write_Byte(CMD_SPI_MULTI);
+ Endpoint_Write_Byte(STATUS_CMD_OK);
+
+ uint8_t CurrTxPos = 0;
+ uint8_t CurrRxPos = 0;
+
+ while (CurrTxPos < RxStartAddr)
+ {
+ if (CurrTxPos < TxBytes)
+ SPI_SendByte(TxData[CurrTxPos]);
+ else
+ SPI_SendByte(0);
+
+ CurrTxPos++;
+ }
+
+ while (CurrRxPos < RxBytes)
+ {
+ if (CurrTxPos < TxBytes)
+ {
+ Endpoint_Write_Byte(SPI_TransferByte(TxData[CurrTxPos]));
+ CurrTxPos++;
+ }
+ else
+ {
+ Endpoint_Write_Byte(SPI_ReceiveByte());
+ }
+
+ CurrRxPos++;
+ }
+
+ Endpoint_Write_Byte(STATUS_CMD_OK);
+ Endpoint_ClearIN();
+}
|