seklyuts/MotorControlModuleSDFM_TMS320F28388D
2
0
Fork 0
Code Issues Pull Requests Packages Projects Releases 4 Wiki Activity

Обновление тестовой версии CM для EFC_IPC_Server_C28

Browse Source
This commit is contained in:
seklyuts 2024-05-21 10:39:19 +03:00
parent 6d997d7233
commit 9bcf133617
2 changed files with 297 additions and 77 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
Projects/ipc_ex2_msgqueue_cm/.ccsproject
View File

@ -10,6 +10,6 @@
<rts value="libc.a"/> <rts value="libc.a"/>
<createSlaveProjects value=""/> <createSlaveProjects value=""/>
<templateProperties value="id=ipc_ex2_msgqueue.projectspec.ipc_ex2_msgqueue_cm"/> <templateProperties value="id=ipc_ex2_msgqueue.projectspec.ipc_ex2_msgqueue_cm"/>
<origin value="D:/MotorControlModuleSDFM_TMS320F28388D/export/ipc_ex2_msgqueue_cm"/> <origin value="D:/MotorControlModuleSDFM_TMS320F28388D/backup/ipc_ex2_msgqueue_cm"/>
<filesToOpen value=""/> <filesToOpen value=""/>
</projectOptions> </projectOptions>

372
Projects/ipc_ex2_msgqueue_cm/ipc_ex2_msgqueue_cm.c
View File

@ -67,28 +67,139 @@
#define TEST_PASS 0x5555 #define TEST_PASS 0x5555
#define TEST_FAIL 0xAAAA #define TEST_FAIL 0xAAAA
#define WRONG_COMMAND 0x10
#define ERROR_VERIFY 0x11
#define FLASH_ERR 0x12
#define FLASH_FAIL 0x13
#define FLASH_ECC_FAIL 0x14
#define WRONG_LENGHT 0x15
#define WRONG_ADDR 0x16
#define WRONG_ID 0x17
#define BUSY 0x18
#define COMMAND_ACCEPTED 0x20
#define DONE_SUCCESS 0x21
IPC_MessageQueue_t messageQueue; IPC_MessageQueue_t messageQueue;
uint16_t WriteToCpu1, ReadFromCpu1; uint16_t WriteToCpu1, ReadFromCpu1;
uint16_t WriteToCpu2, ReadFromCpu2; uint16_t WriteToCpu2, ReadFromCpu2;
uint16_t copyBuf1,copyBuf2,fillBuf1; uint16_t copyBuf1,copyBuf2,fillBuf1,ErraseBuff,Fiil0Buff,TheEndGD25Q16E;
IPC_Message_t TxMsg, RxMsg; IPC_Message_t TxMsg, RxMsg;
//uint16_t IntNum = 1; //uint16_t IntNum = 1;
uint16_t GetMes[16]; uint16_t GetMes[16];
uint16_t PutMes[16]; uint16_t PutMes[16];
uint16_t offset;
uint16_t TempConst = 2; uint16_t TempConst = 2;
uint16_t CounterCPU1Blocks = 0; //uint16_t CounterCPU1Blocks = 0;
uint32_t Command,StartAddr,Data; uint32_t Command=0x0100A3,StartAddr=0x1E7040,Data=160;
uint32_t InCommand,InAddr,InData; uint32_t InCommand,InAddr,InData;
uint16_t Fill_num = 0x0;
uint16_t Array[256]=
{
0x27, 0x17, 0x00, 0x02, 0x00, 0x07, 0x00, 0x0A,
0x27, 0x18, 0x00, 0x02, 0x00, 0x08, 0x00, 0x0A,
0x27, 0x19, 0x00, 0x02, 0x00, 0x09, 0x00, 0x0A,
0x27, 0x1A, 0x00, 0x02, 0x00, 0x0A, 0x00, 0x0A,
0x27, 0x1B, 0x00, 0x02, 0x00, 0x0B, 0x00, 0x0A,
0x27, 0x1C, 0x00, 0x02, 0x00, 0x0C, 0x00, 0x0A,
0x27, 0x1D, 0x00, 0x02, 0x00, 0x0D, 0x00, 0x0A,
0x27, 0x1E, 0x00, 0x02, 0x00, 0x0E, 0x00, 0x0A,
0x27, 0x1F, 0x00, 0x02, 0x00, 0x0F, 0x00, 0x0A,
0x27, 0x20, 0x00, 0x02, 0x00, 0x10, 0x00, 0x0A,
0x27, 0x21, 0x00, 0x02, 0x27, 0x22, 0x00, 0x02,
0x00, 0x11, 0x00, 0x0A, 0x27, 0x23, 0x00, 0x02,
0x00, 0x12, 0x00, 0x0A, 0x27, 0x24, 0x00, 0x02,
0x00, 0x13, 0x00, 0x0A, 0x27, 0x25, 0x00, 0x02,
0x00, 0x14, 0x00, 0x0A, 0x27, 0x26, 0x00, 0x02,
0x00, 0x15, 0x00, 0x0A, 0x27, 0x27, 0x00, 0x02,
0x00, 0x16, 0x00, 0x0A, 0x27, 0x28, 0x00, 0x02,
0x00, 0x17, 0x00, 0x0A, 0x27, 0x29, 0x00, 0x02,
0x00, 0x18, 0x00, 0x0A, 0x27, 0x2A, 0x00, 0x02,
0x00, 0x19, 0x00, 0x0A, 0x27, 0x2B, 0x00, 0x02,
0x27, 0x1F, 0x00, 0x02, 0x00, 0x0F, 0x00, 0x0A,
0x27, 0x20, 0x00, 0x02, 0x00, 0x10, 0x00, 0x0A,
0x27, 0x21, 0x00, 0x02, 0x27, 0x22, 0x00, 0x02,
0x00, 0x11, 0x00, 0x0A, 0x27, 0x23, 0x00, 0x02,
0x00, 0x12, 0x00, 0x0A, 0x27, 0x24, 0x00, 0x02,
0x00, 0x13, 0x00, 0x0A, 0x27, 0x25, 0x00, 0x02,
0x00, 0x14, 0x00, 0x0A, 0x27, 0x26, 0x00, 0x02,
0x00, 0x15, 0x00, 0x0A, 0x27, 0x27, 0x00, 0x02,
0x00, 0x16, 0x00, 0x0A, 0x27, 0x28, 0x00, 0x02,
0x00, 0x17, 0x00, 0x0A, 0x27, 0x29, 0x00, 0x02,
0x00, 0x18, 0x00, 0x0A, 0x27, 0x2A, 0x00, 0x02,
0x00, 0x19, 0x00, 0x0A, 0x27, 0x2B, 0x00, 0x02
};
// IPC ISR for Flag 1 // IPC ISR for Flag 1
// C28x core sends data with message queue using Flag 0 // C28x core sends data with message queue using Flag 0
// //
uint16_t offset;
void FillBuff1_num(uint16_t num)
{
uint16_t i;
uint16_t * Buffer = (uint16_t *)CMTOCPU1MSGRAM0_BASE;
for(i=0; i < 2048; i++)
{
Buffer[i] = num;
}
}
void FillBuff1Array(void)
{
uint16_t i,j,a,b;
uint16_t * Buffer = (uint16_t *)CMTOCPU1MSGRAM0_BASE;
for(j=0; j< 16; j++)
{
for(i=0; i < 256; i++)
{
a = Array[i*2];
b = Array[i*2+1];
Buffer[i+256*j] = b+(a<<8);
}
}
}
uint16_t ErrVerify;
void verifyArray(void)
{
uint16_t i,j,a,b,r1,r2;
uint16_t * Buffer = (uint16_t *)CPU1TOCMMSGRAM0_BASE;
for(j=0; j< 16; j++)
{
for(i=0; i < 256; i++)
{
a = Array[i*2];
b = Array[i*2+1];
r1 = Buffer[i+80*j];
r2 = b+(a<<8);
if(r1 != r2)
{
ErrVerify++;
}
}
}
}
void FillBuff1(void) void FillBuff1(void)
{ {
@ -130,24 +241,24 @@ void buffCopy2(void)
void putMessage_to_CPU1(uint16_t IntNum) void putMessage_to_CPU1(uint16_t IntNum)
{ {
uint16_t i; // uint16_t i;
uint16_t * Buffer = (uint16_t *)CMTOCPU1MSGRAM0_BASE; // uint16_t * Buffer = (uint16_t *)CMTOCPU1MSGRAM0_BASE;
for(i=0; i < 2048; i++) // for(i=0; i < 2048; i++)
{ // {
// Buffer[i] = i*TempConst; // Buffer[i] = i*TempConst;
} // }
// IPC_setFlagLtoR(IPC_CM_L_CPU1_R, (1<<IntNum)); IPC_setFlagLtoR(IPC_CM_L_CPU1_R, (1<<IntNum));
} }
void putMessage_to_CPU2(uint16_t IntNum) void putMessage_to_CPU2(uint16_t IntNum)
{ {
uint16_t i; // uint16_t i;
uint16_t * Buffer = (uint16_t *)CMTOCPU2MSGRAM0_BASE; // uint16_t * Buffer = (uint16_t *)CMTOCPU2MSGRAM0_BASE;
for(i=0; i < 2048; i++) // for(i=0; i < 2048; i++)
{ // {
// Buffer[i] = i*TempConst; // Buffer[i] = i*TempConst;
} // }
// IPC_setFlagLtoR(IPC_CM_L_CPU2_R, (1<<IntNum)); IPC_setFlagLtoR(IPC_CM_L_CPU2_R, (1<<IntNum));
} }
@ -198,29 +309,15 @@ __interrupt void IPC1_ISR1()
} }
__interrupt void IPC1_ISR0()
{
IPC_readCommand(IPC_CM_L_CPU1_R, 0, 0, &InCommand, &InAddr, &InData );
getMessage_from_CPU1(GetMes,16);
if(CounterCPU1Blocks > 0)
{
StartAddr += Data;
offset += Data;
FillBuff1();
CounterCPU1Blocks--;
WriteToCpu1 = 1;
}
else WriteToCpu1 = 0;
// uint16_t ErrStage = 0, TestErrCommand = 0;
// Acknowledge the flag uint16_t stage=0, read_now = 1;
// uint16_t CountErr[257];
CounterISR[1]++;
IPC_ackFlagRtoL(IPC_CM_L_CPU1_R, IPC_FLAG0);
}
__interrupt void IPC2_ISR1() __interrupt void IPC2_ISR1()
{ {
@ -265,6 +362,160 @@ __interrupt void IPC2_ISR0()
// //
void DoItCPU1(void)
{
if(WriteToCpu1 == 1)
{
WriteToCpu1 = 2;
IPC_sendCommand(IPC_CM_L_CPU1_R, 0, 0, Command, StartAddr, Data);
IPC_setFlagLtoR(IPC_CM_L_CPU1_R, (1<<0));
}
// if(ReadFromCpu1 == 1)
// {
// ReadFromCpu1 = 0;
// getMessage_from_CPU1(GetMes,16);
// IPC_readCommand(IPC_CM_L_CPU1_R, 0, 0, &InCommand, &InAddr, &InData );
// }
// if(TheEndGD25Q16E == 1)
// {
// TheEndGD25Q16E = 0;
// IPC_sendCommand(IPC_CM_L_CPU1_R, 0, 0, 0xFF00A3, 0, 0);
// IPC_setFlagLtoR(IPC_CM_L_CPU1_R, (1<<0));
// }
}
//void SendStopToGD25Q16E(void)
//{
// IPC_sendCommand(IPC_CM_L_CPU1_R, 0, 0, 0xFF00A3, 0, 0);
// IPC_setFlagLtoR(IPC_CM_L_CPU1_R, (1<<0));
//}
void DoItCPU2(void)
{
if(WriteToCpu2 == 1)
{
WriteToCpu2 = 2;
IPC_sendCommand(IPC_CM_L_CPU2_R, 0, 0, Command, StartAddr, Data);
IPC_setFlagLtoR(IPC_CM_L_CPU2_R, (1<<0));
}
// if(ReadFromCpu2 == 1)
// {
// ReadFromCpu2 = 0;
// getMessage_from_CPU2(GetMes,16);
// IPC_readCommand(IPC_CM_L_CPU2_R, 0, 0, &InCommand, &InAddr, &InData );
// }
}
void DoItBoof(void)
{
if(copyBuf1 == 1)
{
copyBuf1 = 0;
buffCopy1();
}
if(copyBuf2 == 1)
{
copyBuf2 = 0;
buffCopy2();
}
if(fillBuf1 == 1)
{
fillBuf1 = 0;
FillBuff1Array();
}
if(Fiil0Buff == 1)
{
Fiil0Buff = 0;
FillBuff1_num(Fill_num);
}
}
uint16_t stageStart = 145;
uint16_t stageEnd = 145;
uint16_t Size = 0x1000;
uint16_t OffsetAdr = 0;
void writeAndVerifyAllGD25Q16E(void)
{
if(stage == 0)
{
Command = 0xFF00A3;
StartAddr = 0;
WriteToCpu1 = 1;
}
else
{
if(stage <= 256 )
{
if(stageStart == 0) stageStart++;
if(stage <= 1)stage = stageStart;
if(read_now) Command = 0x0000A3;
else Command = 0x0100A3;
StartAddr = (stage - 1)*0x1000 + OffsetAdr;
Data = Size;
WriteToCpu1 = 1;
if(stage == stageEnd) stage = 256;
}
}
}
uint16_t AdrErr[2048];
void verify_num(uint16_t num)
{
uint16_t i,r1,r2;
uint16_t * Buffer = (uint16_t *)CPU1TOCMMSGRAM0_BASE;
for(i=0; i < (Size/2); i++)
{
r1 = Buffer[i];
r2 = num;
if(r1 != r2)
{
AdrErr[ErrVerify] = i*2;
ErrVerify++;
}
}
}
__interrupt void IPC1_ISR0()
{
IPC_readCommand(IPC_CM_L_CPU1_R, 0, 0, &InCommand, &InAddr, &InData );
getMessage_from_CPU1(GetMes,16);
WriteToCpu1 = 0;
TestErrCommand = InCommand>>16;
if((TestErrCommand != COMMAND_ACCEPTED) && (TestErrCommand != DONE_SUCCESS) )
{
ErrStage++;
}
if(Command == 0x0000A3)
{
verify_num(Fill_num);
}
CountErr[stage] = ErrVerify;
ErrVerify = 0;
stage++;
//
// Acknowledge the flag
//
CounterISR[1]++;
IPC_ackFlagRtoL(IPC_CM_L_CPU1_R, IPC_FLAG0);
}
void main(void) void main(void)
{ {
// //
@ -298,49 +549,18 @@ void main(void)
// //
// Loop forever. Wait for IPC interrupt // Loop forever. Wait for IPC interrupt
// //
//FillBuff1Array();
FillBuff1_num(Fill_num);
stage = 257;
while(1) while(1)
{ {
if(WriteToCpu1 == 1) DoItCPU1();
{ DoItCPU2();
WriteToCpu1 = 2; DoItBoof();
IPC_sendCommand(IPC_CM_L_CPU1_R, 0, 0, Command, StartAddr, Data);
IPC_setFlagLtoR(IPC_CM_L_CPU1_R, (1<<0));
}
if(WriteToCpu2 == 1)
{
WriteToCpu2 = 2;
IPC_sendCommand(IPC_CM_L_CPU2_R, 0, 0, Command, StartAddr, Data);
IPC_setFlagLtoR(IPC_CM_L_CPU2_R, (1<<0));
}
if(ReadFromCpu1 == 1)
{
ReadFromCpu1 = 0;
getMessage_from_CPU1(GetMes,16);
IPC_readCommand(IPC_CM_L_CPU1_R, 0, 0, &InCommand, &InAddr, &InData );
}
if(copyBuf1 == 1)
{
copyBuf1 = 0;
buffCopy1();
}
if(ReadFromCpu2 == 1)
{
ReadFromCpu2 = 0;
getMessage_from_CPU2(GetMes,16);
IPC_readCommand(IPC_CM_L_CPU2_R, 0, 0, &InCommand, &InAddr, &InData );
}
if(copyBuf2 == 1)
{
copyBuf2 = 0;
buffCopy2();
}
if(fillBuf1 == 1)
{
fillBuf1 = 0;
FillBuff1();
}
if(WriteToCpu1 == 0) writeAndVerifyAllGD25Q16E();
} }
} }