X-Git-Url: http://git.linex4red.de/pub/USBasp.git/blobdiff_plain/083d3615d327a90aeaed9adc74eb997315daaafd..32cc2b8d4d9f2c66a9dbfa859f476c077592e2cf:/Projects/Unfinished/AVRISP/Lib/V2Protocol.c diff --git a/Projects/Unfinished/AVRISP/Lib/V2Protocol.c b/Projects/Unfinished/AVRISP/Lib/V2Protocol.c index 2679ce7f7..905214c6d 100644 --- a/Projects/Unfinished/AVRISP/Lib/V2Protocol.c +++ b/Projects/Unfinished/AVRISP/Lib/V2Protocol.c @@ -36,29 +36,108 @@ #define INCLUDE_FROM_V2PROTOCOL_C #include "V2Protocol.h" -ParameterItem_t ParameterTable[] EEMEM = +/* Table of masks for SPI_Init() from a given PARAM_SCK_DURATION value */ +static const uint8_t SPIMaskFromSCKDuration[] = + { + #if (F_CPU == 8000000) + SPI_SPEED_FCPU_DIV_2, + #endif + SPI_SPEED_FCPU_DIV_2, SPI_SPEED_FCPU_DIV_4, SPI_SPEED_FCPU_DIV_8, + SPI_SPEED_FCPU_DIV_16, SPI_SPEED_FCPU_DIV_32, SPI_SPEED_FCPU_DIV_64 + #if (F_CPU == 16000000) + , SPI_SPEED_FCPU_DIV_128 + #endif + }; + +/* Non-Volatile Parameter Values for EEPROM storage */ +uint8_t EEMEM EEPROM_Rest_Polarity; + +/* Volatile Parameter Values for RAM storage */ +static ParameterItem_t ParameterTable[] = { { .ParameterID = PARAM_BUILD_NUMBER_LOW, - .ParameterValue = 0x00 }, + .ParameterValue = (LUFA_VERSION_INTEGER >> 8) }, { .ParameterID = PARAM_BUILD_NUMBER_HIGH, - .ParameterValue = 0x00 }, + .ParameterValue = (LUFA_VERSION_INTEGER & 0xFF) }, { .ParameterID = PARAM_HW_VER, - .ParameterValue = 0x01 }, + .ParameterValue = 0x01 }, { .ParameterID = PARAM_SW_MAJOR, - .ParameterValue = 0x01 }, + .ParameterValue = 0x01 }, { .ParameterID = PARAM_SW_MINOR, - .ParameterValue = 0x00 }, + .ParameterValue = 0x00 }, { .ParameterID = PARAM_VTARGET, - .ParameterValue = 0x00 }, + .ParameterValue = 0x00 }, { .ParameterID = PARAM_SCK_DURATION, - .ParameterValue = 0x00 }, + .ParameterValue = sizeof(SPIMaskFromSCKDuration) }, { .ParameterID = PARAM_RESET_POLARITY, - .ParameterValue = 0x00 }, + .ParameterValue = 0x01 }, { .ParameterID = PARAM_STATUS_TGT_CONN, - .ParameterValue = 0x00 }, + .ParameterValue = 0x00 }, { .ParameterID = PARAM_DISCHARGEDELAY, - .ParameterValue = 0x00 }, + .ParameterValue = 0x00 }, }; + + +static void V2Protocol_ReconfigureSPI(void) +{ + uint8_t SCKDuration = V2Protocol_GetParameter(PARAM_SCK_DURATION); + + if (SCKDuration >= sizeof(SPIMaskFromSCKDuration)) + SCKDuration = (sizeof(SPIMaskFromSCKDuration) - 1); + + SPI_Init(SPIMaskFromSCKDuration[SCKDuration], true); +} + +static void V2Protocol_ChangeTargetResetLine(bool ResetTarget) +{ + if (ResetTarget) + { + RESET_LINE_DDR |= RESET_LINE_MASK; + + if (!(V2Protocol_GetParameter(PARAM_RESET_POLARITY))) + RESET_LINE_PORT |= RESET_LINE_MASK; + } + else + { + RESET_LINE_PORT &= ~RESET_LINE_MASK; + RESET_LINE_DDR &= ~RESET_LINE_MASK; + } +} + +static uint8_t V2Protocol_GetParameter(uint8_t ParamID) +{ + /* Find the parameter in the parameter table and retrieve the value */ + for (uint8_t TableIndex = 0; TableIndex < (sizeof(ParameterTable) / sizeof(ParameterTable[0])); TableIndex++) + { + if (ParamID == ParameterTable[TableIndex].ParameterID) + return ParameterTable[TableIndex].ParameterValue; + } + + return 0; +} + +static void V2Protocol_SetParameter(uint8_t ParamID, uint8_t 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); + + /* Find the parameter in the parameter table and store the new value */ + for (uint8_t TableIndex = 0; TableIndex < (sizeof(ParameterTable) / sizeof(ParameterTable[0])); TableIndex++) + { + if (ParamID == ParameterTable[TableIndex].ParameterID) + { + ParameterTable[TableIndex].ParameterValue = Value; + return; + } + } +} + +void V2Protocol_Init(void) +{ + /* Target RESET line polarity is a non-volatile value, retrieve current parameter value from EEPROM */ + V2Protocol_SetParameter(PARAM_RESET_POLARITY, eeprom_read_byte(&EEPROM_Rest_Polarity)); +} void V2Protocol_ProcessCommand(void) { @@ -67,52 +146,50 @@ void V2Protocol_ProcessCommand(void) switch (V2Command) { case CMD_SIGN_ON: - V2Protocol_ProcessCmdSignOn(); + V2Protocol_Command_SignOn(); break; case CMD_SET_PARAMETER: case CMD_GET_PARAMETER: - V2Protocol_ProcessCmdGetSetParam(V2Command); + V2Protocol_Command_GetSetParam(V2Command); break; + case CMD_SPI_MULTI: + V2Protocol_Command_SPIMulti(); + break; default: - while (Endpoint_BytesInEndpoint() == AVRISP_DATA_EPSIZE) - { - Endpoint_ClearOUT(); - while (!(Endpoint_IsOUTReceived())); - } - - Endpoint_ClearOUT(); - Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN); - - Endpoint_Write_Byte(STATUS_CMD_UNKNOWN); - Endpoint_ClearIN(); + V2Protocol_Command_Unknown(V2Command); break; } 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); -} +} -static ParameterItem_t* V2Protocol_GetParameterItem(uint8_t ParamID) -{ - for (uint8_t TableIndex = 0; TableIndex < (sizeof(ParameterTable) / sizeof(ParameterTable[0])); TableIndex++) +static void V2Protocol_Command_Unknown(uint8_t V2Command) +{ + while (Endpoint_BytesInEndpoint() == AVRISP_DATA_EPSIZE) { - if (ParamID == eeprom_read_byte(&ParameterTable[TableIndex].ParameterID)) - return &ParameterTable[TableIndex]; + Endpoint_ClearOUT(); + while (!(Endpoint_IsOUTReceived())); } - - return NULL; -} + + Endpoint_ClearOUT(); + Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN); + + Endpoint_Write_Byte(V2Command); + Endpoint_Write_Byte(STATUS_CMD_UNKNOWN); + Endpoint_ClearIN(); +} -static void V2Protocol_ProcessCmdSignOn(void) +static void V2Protocol_Command_SignOn(void) { Endpoint_ClearOUT(); Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN); Endpoint_WaitUntilReady(); + V2Protocol_ReconfigureSPI(); + Endpoint_Write_Byte(CMD_SIGN_ON); Endpoint_Write_Byte(STATUS_CMD_OK); Endpoint_Write_Byte(PROGRAMMER_ID_LEN); @@ -120,7 +197,7 @@ static void V2Protocol_ProcessCmdSignOn(void) Endpoint_ClearIN(); } -static void V2Protocol_ProcessCmdGetSetParam(uint8_t V2Command) +static void V2Protocol_Command_GetSetParam(uint8_t V2Command) { uint8_t ParamID = Endpoint_Read_Byte(); uint8_t ParamValue = Endpoint_Read_Byte(); @@ -129,22 +206,56 @@ static void V2Protocol_ProcessCmdGetSetParam(uint8_t V2Command) Endpoint_SetEndpointDirection(ENDPOINT_DIR_IN); Endpoint_WaitUntilReady(); - ParameterItem_t* ParameterItem = V2Protocol_GetParameterItem(ParamID); - - if (ParameterItem != NULL) - { - Endpoint_Write_Byte(V2Command); - Endpoint_Write_Byte(STATUS_CMD_OK); + Endpoint_Write_Byte(V2Command); + Endpoint_Write_Byte(STATUS_CMD_OK); - if (V2Command == CMD_SET_PARAMETER) - eeprom_write_byte(&ParameterItem->ParameterValue, ParamValue); - else - Endpoint_Write_Byte(eeprom_read_byte(&ParameterItem->ParameterValue)); - } + if (V2Command == CMD_SET_PARAMETER) + V2Protocol_SetParameter(ParamID, ParamValue); else + Endpoint_Write_Byte(V2Protocol_GetParameter(ParamID)); + + Endpoint_ClearIN(); +} + +static void V2Protocol_Command_SPIMulti(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) { - Endpoint_Write_Byte(STATUS_CMD_FAILED); + if (CurrTxPos < TxBytes) + SPI_SendByte(TxData[CurrTxPos]); + else + SPI_SendByte(0); + + CurrTxPos++; } - Endpoint_ClearIN(); + while (CurrRxPos < RxBytes) + { + if (CurrTxPos < TxBytes) + Endpoint_Write_Byte(SPI_TransferByte(TxData[CurrTxPos++])); + else + Endpoint_Write_Byte(SPI_ReceiveByte()); + + CurrRxPos++; + } + + Endpoint_Write_Byte(STATUS_CMD_OK); + Endpoint_ClearIN(); }