1 | int main(void)
|
2 | {
|
3 |
|
4 | initAll(); // Initialisieren diverser Funktionen
|
5 | sensorVektor = 0;
|
6 | motorVektor = 0;
|
7 | panelVektor = 0;
|
8 | akkuVektor = 0;
|
9 |
|
10 |
|
11 | while(1) // unendliche Schleife
|
12 | {
|
13 |
|
14 | displayString("waiting ",0,"for user",0,500);
|
15 | do
|
16 | {
|
17 | readAllButtons();
|
18 | }
|
19 | while(sw1_slope == 0); // Warte auf Eingabe
|
20 | sw1_slope = 0;
|
21 |
|
22 | hauptVektor = 0b00110001; // Zustandsvektor der Hauptplatine
|
23 | forceVektor = 0b00000001;
|
24 |
|
25 | displayString("Send",0,"in progress",0,1);
|
26 |
|
27 | sendData(); // Versenden des eigenen Zustandsvektors und der ForceBefehle
|
28 |
|
29 | displayString("Get",0,"in progress",0,1);
|
30 |
|
31 | getData(); //
|
32 |
|
33 | displayString("Sensorvektor",0,"",0,0);
|
34 | printValue(sensorVektor,1000);
|
35 | displayString("Motorvektor",0,"",0,0);
|
36 | printValue(motorVektor,1000);
|
37 | displayString("Panelvektor",0,"",0,0);
|
38 | printValue(panelVektor,1000);
|
39 | displayString("Akkuvektor",0,"",0,0);
|
40 | printValue(akkuVektor,1000);
|
41 |
|
42 | }
|
43 | return 0;
|
44 |
|
45 | }
|
46 |
|
47 |
|
48 |
|
49 | // Daten senden ========================================================================
|
50 |
|
51 | void sendData(void) // Versenden des eigenen Zustandsvektors und der ForceBefehle
|
52 | {
|
53 |
|
54 | displayString("sende Haupt",0,"in progress",0,1000);
|
55 |
|
56 | sendValue(0, hauptVektor); // Versenden des Eigenen Zustandes über General Call
|
57 |
|
58 | displayString("Sende Force",0,"in progress",0,1000);
|
59 |
|
60 | sendValue(80, forceVektor); // Versenden der ForcWerte an die Motorsteuerung (SensorCPU)
|
61 |
|
62 |
|
63 | }
|
64 |
|
65 |
|
66 | // Werteanforderung ========================================================================
|
67 |
|
68 | void getData(void) // Start der Funktion
|
69 | {
|
70 |
|
71 | displayString("Hole Sensor",0,"in progress",0,1000);
|
72 |
|
73 | getValue(80,2); // Einholen der Zusatndsvektoren vom Sensor
|
74 | sensorVektor = Value3[1];
|
75 | motorVektor = Value3[2];
|
76 |
|
77 | displayString("Hole Spannung",0,"in progress",0,1000);
|
78 |
|
79 | getValue(96,2); // Einholen der Zusandsvektoren vom Panel
|
80 | panelVektor = Value3[1];
|
81 | akkuVektor = Value3[2];
|
82 |
|
83 | }
|
84 |
|
85 |
|
86 |
|
87 | /*********************************************************************************************/
|
88 | // TWI Master Übergriffe ==================================================================
|
89 | /*********************************************************************************************/
|
90 |
|
91 |
|
92 | // Master als Transmitter ==========================================================
|
93 |
|
94 | void sendValue(unsigned char SlaveAdress, unsigned char Value)
|
95 |
|
96 | {
|
97 |
|
98 |
|
99 | TWCR = START; // Sende Startkondition
|
100 | do {}
|
101 | while (!(TWCR & (1<<TWINT))); // Bis TWINT Flag gesetzt ist
|
102 |
|
103 |
|
104 | if ((TWSR & 0xF8) == TW_START) // Startbedingung gesendet
|
105 | {
|
106 |
|
107 |
|
108 | TWDR = (SlaveAdress | TW_WRITE); // Slaveadresse und Schreibbedingung
|
109 | TWCR = TRANSMIT; // Aktivieren des Sendevorgangs
|
110 |
|
111 | do {}
|
112 | while (!(TWCR & (1<<TWINT)));
|
113 |
|
114 |
|
115 | if ((TWSR & 0xF8) == TW_MT_SLA_ACK) // Slaveadresse mit Schreibbedingung gesendet
|
116 | { // ACK vom Slave bekommen
|
117 |
|
118 |
|
119 | TWDR = Value; // Übermittlungswert in Schiftregister
|
120 | TWCR = TRANSMIT; // Aktivieren des Sendevorgangs
|
121 |
|
122 |
|
123 | do {}
|
124 | while (!(TWCR & (1<<TWINT))); // Bis TWINT Flag gesetzt ist
|
125 |
|
126 | if ((TWSR & 0xF8) == TW_MT_DATA_ACK)// Daten wurde versendet
|
127 | { // ACK vom Slave bekommen
|
128 |
|
129 | }
|
130 | else if ((TWSR & 0xF8) == TW_MT_DATA_NACK)// Daten wurde versendet
|
131 | { // Kein ACK vom Slave bekommen
|
132 | displayString("Daten Fehler",0,"reagiert nicht",0,500);
|
133 | }
|
134 | else
|
135 | {
|
136 | displayString("SRG Fehler",0,"",0,500); // Genereller Serviceregisterfehler
|
137 | } // Registerinhalt passt überhaupt nicht zu dem Kontext
|
138 | }
|
139 | else if ((TWSR & 0xF8) == TW_MT_SLA_NACK) // Slaveadresse mit Schreibbedingung gesendet
|
140 | { // Kein ACK vom Slave bekommen
|
141 | displayString("Slave Fehler",0,"reagiert nicht",0,500);
|
142 | }
|
143 | else
|
144 | {
|
145 | displayString("SRG Fehler",0,"",0,500); // Genereller Serviceregisterfehler
|
146 | } // Registerinhalt passt überhaupt nicht zu dem Kontext
|
147 | }
|
148 | else
|
149 | {
|
150 | displayString("STA Fehler",0,"nicht gesendet",0,500);
|
151 | }
|
152 |
|
153 |
|
154 | TWCR = STOP; // Transmit Stop
|
155 | _delay_us(50);
|
156 |
|
157 |
|
158 | }
|
159 |
|
160 |
|
161 | // Master als Receiver ==========================================================
|
162 |
|
163 |
|
164 | void getValue(unsigned char SlaveAdress, char numLoops)
|
165 |
|
166 | {
|
167 |
|
168 | unsigned char i = 0;
|
169 |
|
170 | for(i=0; i<=2; i++) // Löschen des Variablenvektors zu Beginn
|
171 | {
|
172 | Value3[i]=0;
|
173 | }
|
174 |
|
175 | TWCR = START; // Sende Startkondition
|
176 |
|
177 | do {}
|
178 | while (!(TWCR & (1<<TWINT))); // Bis TWINT Flag gesetzt ist
|
179 |
|
180 |
|
181 |
|
182 | if ((TWSR & 0xF8) == TW_START) // Startbedingung gesendet
|
183 | {
|
184 |
|
185 | TWDR = (SlaveAdress | TW_READ); // Slaveadresse und Schreibbedingung
|
186 | TWCR = TRANSACK; // Aktivieren des Sendevorgangs
|
187 |
|
188 | do {}
|
189 | while (!(TWCR & (1<<TWINT)));
|
190 |
|
191 | if ((TWSR & 0xF8) == TW_MR_SLA_ACK) // Slaveadresse mit Lesebedingung gesendet
|
192 | { // ACK vom Slave bekommen
|
193 |
|
194 |
|
195 | for(i=1; i<=numLoops; i++)
|
196 | {
|
197 |
|
198 | TWCR = TRANSACK; // Sendebefehl mit Acknowledge-Anweisung
|
199 |
|
200 |
|
201 | do {}
|
202 | while (!(TWCR & (1<<TWINT)));
|
203 |
|
204 | if ((TWSR & 0xF8) == TW_MR_DATA_ACK) // Datenpacket von Slave wurde erhalten
|
205 | { // ACK wurde an Slave gesendet
|
206 |
|
207 | Value3[i] = TWDR; // den gegenwertigen Registerwert in eine Temporäre Variable übernehmen
|
208 |
|
209 | }
|
210 |
|
211 | else if ((TWSR & 0xF8) == TW_MR_DATA_NACK) // Datenpacket von Slave wurde erhalten
|
212 | { // Kein ACK wurde an Slave gesendet
|
213 | displayString("Daten Fehler",0,"reagiert nicht",0,500);
|
214 | }
|
215 | else
|
216 | {
|
217 | displayString("SRG1 Fehler",0,"",0,500); // Genereller Serviceregisterfehler
|
218 | }
|
219 | }
|
220 | }
|
221 | else if ((TWSR & 0xF8) == TW_MR_SLA_NACK) // Slaveadresse mit Lesebedingung gesendet
|
222 | { // Kein ACK vom Slave bekommen
|
223 | displayString("Slave Fehler",0,"reagiert nicht",0,500);
|
224 | }
|
225 | else
|
226 | {
|
227 | displayString("SRG2 Fehler",0,"",0,500); // Genereller Serviceregisterfehler
|
228 | }
|
229 | }
|
230 | else
|
231 | {
|
232 | displayString("STA Fehler",0,"nicht gesendet",0,500);
|
233 | }
|
234 |
|
235 | TWCR = STOP; // Transmit Stop
|
236 | _delay_us(50);
|
237 |
|
238 | }
|
239 |
|
240 |
|
241 |
|
242 | /*********************************************************************************************/
|
243 | // Initialisierungsroutinen ==================================================================
|
244 | /*********************************************************************************************/
|
245 |
|
246 |
|
247 | // TWI Initialisierung
|
248 |
|
249 | void setTWIMaster(void)
|
250 | {
|
251 |
|
252 | sei(); // Generelles einschalten der Interrupts
|
253 | TWCR = (1<<TWEN); // TWI Schnittstelle schon mal einschalten
|
254 | TWBR = 0x10; // BitrateRegister auf 16 setzten
|
255 | TWSR = 0x02; // TWI Prescaler auf 16 setzen
|
256 |
|
257 | // Mit dieser Einstellung lassen sich immer noch
|
258 | // ca. 1400 Pakete pro Sekunde verschicken
|
259 | }
|