Subversion Repositories FlightCtrl

Rev

Rev 617 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
304 ingob 1
// ######################## SPI - FlightCtrl ###################
2
#include "main.h"
3
 
4
 
5
struct str_ToNaviCtrl      ToNaviCtrl;
6
struct str_FromNaviCtrl    FromNaviCtrl;
7
unsigned char              SPI_BufferIndex;
8
volatile unsigned char     SPI_Buffer[sizeof(FromNaviCtrl)];
9
unsigned char *Ptr_buffer = (unsigned char *) &ToNaviCtrl;
606 ingob 10
 
617 ingob 11
unsigned char SPITransferCompleted, SPI_ChkSum;
597 ingob 12
#ifdef USE_SPI_COMMUNICATION
691 ingob 13
 
304 ingob 14
//------------------------------------------------------
15
void SPI_MasterInit(void)
16
{
17
  DDR_SPI |= (1<<DD_MOSI)|(1<<DD_SCK);    // Set MOSI and SCK output, all others input 
18
  SLAVE_SELECT_DDR_PORT |= (1 << SPI_SLAVE_SELECT);
19
 
691 ingob 20
  SPCR = (1<<SPE)|(1<<MSTR)|(1<<SPR1)|(0<<SPR0)|(0<<SPIE);   // Enable SPI, Master, set clock rate fck/64 
21
  SPSR = 0;  // SPI2X
22
 
304 ingob 23
  SLAVE_SELECT_PORT |=  (1 << SPI_SLAVE_SELECT);
606 ingob 24
  SPITransferCompleted = 1;
25
 
26
  ToNaviCtrl.Sync1 = 0x81;
27
  ToNaviCtrl.Sync2 = 0x55;
28
 
617 ingob 29
  ToNaviCtrl.Comp = 12;
30
  ToNaviCtrl.IntegralNick = 12345;
31
  ToNaviCtrl.IntegralRoll = 56789;
32
  ToNaviCtrl.StickNick = 100;
33
  ToNaviCtrl.StickRoll = 150;//(char) StickRoll;
34
  ToNaviCtrl.StickGier = 200;//(char) StickGier;
606 ingob 35
 
304 ingob 36
}
37
 
38
//------------------------------------------------------
39
void SPI_StartTransmitPacket(void)
40
{
606 ingob 41
   //if ((SLAVE_SELECT_PORT & (1 << SPI_SLAVE_SELECT)) == 0) return;    // transfer of prev. packet not completed
42
   if (!SPITransferCompleted) return;
304 ingob 43
 
44
   SLAVE_SELECT_PORT &=  ~(1 << SPI_SLAVE_SELECT);  // SelectSlave
617 ingob 45
 
606 ingob 46
   SPITransferCompleted = 0;
304 ingob 47
   UpdateSPI_Buffer();                              // update buffer
48
   SPI_BufferIndex = 1;
49
   DebugOut.Analog[16]++;
50
   // -- Debug-Output ---
51
   //----
691 ingob 52
   asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop");         asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop");
53
   asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop");         asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop");
54
   asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop");         asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop");
606 ingob 55
   SPDR = ToNaviCtrl.Sync1;                  // Start transmission 
617 ingob 56
   ToNaviCtrl.ChkSum = ToNaviCtrl.Sync1;
691 ingob 57
//     SLAVE_SELECT_PORT |=  (1 << SPI_SLAVE_SELECT);   // DeselectSlave
58
 
304 ingob 59
}
60
 
61
//------------------------------------------------------
62
//SIGNAL(SIG_SPI)
63
void SPI_TransmitByte(void)
64
{
691 ingob 65
 
66
   if (SPITransferCompleted) return;
304 ingob 67
   if (!(SPSR & (1 << SPIF))) return;
691 ingob 68
 
606 ingob 69
  SLAVE_SELECT_PORT |=  (1 << SPI_SLAVE_SELECT);   // DeselectSlave
70
 
304 ingob 71
          if (SPI_BufferIndex < sizeof(FromNaviCtrl))
606 ingob 72
      {
73
            SPI_Buffer[SPI_BufferIndex]= SPDR;             // get data 
617 ingob 74
 
596 ingob 75
//              if (SPI_BufferIndex < 32 ) DebugOut.Analog[26+SPI_BufferIndex] = SPI_Buffer[SPI_BufferIndex];
76
 
304 ingob 77
        //if(SPDR!= 0x00) DebugOut.Analog[19]++; ;             
78
          }
79
 
80
   if (SPI_BufferIndex < sizeof(ToNaviCtrl))  
606 ingob 81
     {
82
           SLAVE_SELECT_PORT &=  ~(1 << SPI_SLAVE_SELECT);  // SelectSlave
691 ingob 83
           asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop");         asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop");
84
           asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop");         asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop");
85
           asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop");         asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop");
617 ingob 86
 
606 ingob 87
           SPDR = Ptr_buffer[SPI_BufferIndex];
617 ingob 88
           ToNaviCtrl.ChkSum += Ptr_buffer[SPI_BufferIndex];
691 ingob 89
        //   SLAVE_SELECT_PORT |=  (1 << SPI_SLAVE_SELECT);   // DeselectSlave
90
 
606 ingob 91
         }
304 ingob 92
   else
93
     {
94
           unsigned char *ptr = (unsigned char *)&FromNaviCtrl;
596 ingob 95
 
606 ingob 96
       SPITransferCompleted = 1;  
304 ingob 97
       memcpy(ptr, (unsigned char *) SPI_Buffer,  sizeof(SPI_Buffer));
98
         }
99
 
100
         SPI_BufferIndex++;
101
}
102
 
691 ingob 103
/*
104
void SPI_MasterInit(void)
105
{
106
  DDR_SPI |= (1<<DD_MOSI)|(1<<DD_SCK);    // Set MOSI and SCK output, all others input
107
  SLAVE_SELECT_DDR_PORT |= (1 << SPI_SLAVE_SELECT);
108
 
109
  SPCR = (1<<SPE)|(1<<MSTR)|(1<<SPR1)|(0<<SPIE);   // Enable SPI, Master, set clock rate fck/64
110
  SLAVE_SELECT_PORT |=  (1 << SPI_SLAVE_SELECT);
111
  SPITransferCompleted = 1;
112
 
113
  ToNaviCtrl.Sync1 = 0x81;
114
  ToNaviCtrl.Sync2 = 0x55;
115
 
116
 
117
}
118
 
304 ingob 119
//------------------------------------------------------
691 ingob 120
void SPI_StartTransmitPacket(void)
121
{
122
   //if ((SLAVE_SELECT_PORT & (1 << SPI_SLAVE_SELECT)) == 0) return;    // transfer of prev. packet not completed
123
   if (!SPITransferCompleted) return;
124
 
125
   SLAVE_SELECT_PORT &=  ~(1 << SPI_SLAVE_SELECT);  // SelectSlave
126
   SPITransferCompleted = 0;
127
   UpdateSPI_Buffer();                              // update buffer
128
   SPI_BufferIndex = 1;
129
   DebugOut.Analog[16]++;
130
   // -- Debug-Output ---
131
   //----
132
   SPDR = ToNaviCtrl.Sync1;                  // Start transmission
133
}
134
 
135
//------------------------------------------------------
136
//SIGNAL(SIG_SPI)
137
void SPI_TransmitByte(void)
138
{
139
   if (!(SPSR & (1 << SPIF))) return;
140
  SLAVE_SELECT_PORT |=  (1 << SPI_SLAVE_SELECT);   // DeselectSlave
141
 
142
          if (SPI_BufferIndex < sizeof(FromNaviCtrl))
143
      {
144
            SPI_Buffer[SPI_BufferIndex]= SPDR;             // get data
145
//              if (SPI_BufferIndex < 32 ) DebugOut.Analog[26+SPI_BufferIndex] = SPI_Buffer[SPI_BufferIndex];
146
 
147
        //if(SPDR!= 0x00) DebugOut.Analog[19]++; ;            
148
          }
149
 
150
   if (SPI_BufferIndex < sizeof(ToNaviCtrl))  
151
     {
152
           asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop");
153
           SLAVE_SELECT_PORT &=  ~(1 << SPI_SLAVE_SELECT);  // SelectSlave
154
           asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop"); asm volatile ("nop");
155
           SPDR = Ptr_buffer[SPI_BufferIndex];
156
         }
157
   else
158
     {
159
           unsigned char *ptr = (unsigned char *)&FromNaviCtrl;
160
 
161
       SPITransferCompleted = 1;  
162
       memcpy(ptr, (unsigned char *) SPI_Buffer,  sizeof(SPI_Buffer));
163
         }
164
 
165
         SPI_BufferIndex++;
166
}
167
*/
168
//------------------------------------------------------
304 ingob 169
void UpdateSPI_Buffer(void)
170
{
691 ingob 171
  static unsigned char i =0;
304 ingob 172
  cli();
173
  ToNaviCtrl.Comp = SPI_PROTOCOL_COMP;
174
  ToNaviCtrl.IntegralNick = (int) (IntegralNick >> 4);
175
  ToNaviCtrl.IntegralRoll = (int) (IntegralRoll >> 4);
606 ingob 176
  ToNaviCtrl.StickNick = 4;
177
  ToNaviCtrl.StickRoll = 5;//(char) StickRoll;
178
  ToNaviCtrl.StickGier = 6;//(char) StickGier;
304 ingob 179
  sei();
691 ingob 180
 
304 ingob 181
}
182
 
597 ingob 183
#endif
304 ingob 184
 
185