| 7,6 → 7,8 |
|---|
| unsigned char SPI_BufferIndex; |
| volatile unsigned char SPI_Buffer[sizeof(FromNaviCtrl)]; |
| unsigned char *Ptr_buffer = (unsigned char *) &ToNaviCtrl; |
| |
| unsigned char SPITransferCompleted; |
| #ifdef USE_SPI_COMMUNICATION |
| //------------------------------------------------------ |
| void SPI_MasterInit(void) |
| 16,14 → 18,22 |
|---|
| |
| SPCR = (1<<SPE)|(1<<MSTR)|(1<<SPR1)|(0<<SPIE); // Enable SPI, Master, set clock rate fck/64 |
| SLAVE_SELECT_PORT |= (1 << SPI_SLAVE_SELECT); |
| SPITransferCompleted = 1; |
| |
| ToNaviCtrl.Sync1 = 0x81; |
| ToNaviCtrl.Sync2 = 0x55; |
| |
| |
| } |
| |
| //------------------------------------------------------ |
| void SPI_StartTransmitPacket(void) |
| { |
| if ((SLAVE_SELECT_PORT & (1 << SPI_SLAVE_SELECT)) == 0) return; // transfer of prev. packet not completed |
| //if ((SLAVE_SELECT_PORT & (1 << SPI_SLAVE_SELECT)) == 0) return; // transfer of prev. packet not completed |
| if (!SPITransferCompleted) return; |
| |
| SLAVE_SELECT_PORT &= ~(1 << SPI_SLAVE_SELECT); // SelectSlave |
| SPITransferCompleted = 0; |
| UpdateSPI_Buffer(); // update buffer |
| SPI_BufferIndex = 1; |
| DebugOut.Analog[16]++; |
| 34,7 → 44,7 |
|---|
| DebugOut.Analog[23] = FromNaviCtrl.CompassValue; |
| */ |
| //---- |
| SPDR = ToNaviCtrl.Comp; // Start transmission |
| SPDR = ToNaviCtrl.Sync1; // Start transmission |
| } |
| |
| //------------------------------------------------------ |
| 42,9 → 52,11 |
|---|
| void SPI_TransmitByte(void) |
| { |
| if (!(SPSR & (1 << SPIF))) return; |
| |
| SLAVE_SELECT_PORT |= (1 << SPI_SLAVE_SELECT); // DeselectSlave |
| |
| if (SPI_BufferIndex < sizeof(FromNaviCtrl)) |
| { SPI_Buffer[SPI_BufferIndex]= SPDR; // get data |
| { |
| SPI_Buffer[SPI_BufferIndex]= SPDR; // get data |
| // if (SPI_BufferIndex < 32 ) DebugOut.Analog[26+SPI_BufferIndex] = SPI_Buffer[SPI_BufferIndex]; |
| |
| //if(SPDR!= 0x00) DebugOut.Analog[19]++; ; |
| 51,14 → 63,17 |
|---|
| } |
| |
| if (SPI_BufferIndex < sizeof(ToNaviCtrl)) |
| { SPDR = Ptr_buffer[SPI_BufferIndex]; |
| |
| } |
| { |
| asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop"); |
| SLAVE_SELECT_PORT &= ~(1 << SPI_SLAVE_SELECT); // SelectSlave |
| asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop"); |
| SPDR = Ptr_buffer[SPI_BufferIndex]; |
| } |
| else |
| { |
| unsigned char *ptr = (unsigned char *)&FromNaviCtrl; |
| |
| SLAVE_SELECT_PORT |= (1 << SPI_SLAVE_SELECT); // DeselectSlave |
| SPITransferCompleted = 1; |
| memcpy(ptr, (unsigned char *) SPI_Buffer, sizeof(SPI_Buffer)); |
| } |
| |
| 68,13 → 83,14 |
|---|
| //------------------------------------------------------ |
| void UpdateSPI_Buffer(void) |
| { |
| static unsigned char i =0; |
| cli(); |
| ToNaviCtrl.Comp = SPI_PROTOCOL_COMP; |
| ToNaviCtrl.IntegralNick = (int) (IntegralNick >> 4); |
| ToNaviCtrl.IntegralRoll = (int) (IntegralRoll >> 4); |
| ToNaviCtrl.StickNick = (char) StickNick; |
| ToNaviCtrl.StickRoll = (char) StickRoll; |
| ToNaviCtrl.StickGier = (char) StickGier; |
| ToNaviCtrl.StickNick = 4; |
| ToNaviCtrl.StickRoll = 5;//(char) StickRoll; |
| ToNaviCtrl.StickGier = 6;//(char) StickGier; |
| sei(); |
| } |
| |