Go to most recent revision | Details | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
1 | ingob | 1 | /*############################################################################ |
2 | Slaveadr = 0x52 = Vorne, 0x54 = Hinten, 0x56 = Rechts, 0x58 = Links |
||
3 | ############################################################################*/ |
||
4 | |||
5 | #include <avr/io.h> |
||
6 | #include <util/twi.h> |
||
7 | #include "main.h" |
||
8 | |||
9 | unsigned char I2C_RXBuffer; |
||
10 | unsigned char Byte_Counter=0; |
||
11 | |||
12 | //############################################################################ |
||
13 | //I2C (TWI) Interface Init |
||
14 | void InitIC2_Slave(uint8_t adr) |
||
15 | //############################################################################ |
||
16 | { |
||
17 | TWAR = adr + (2*MOTORADRESSE); // Eigene Adresse setzen |
||
18 | TWCR = (1<<TWINT) | (1<<TWEN) | (1<<TWIE) | (1<<TWEA); |
||
19 | } |
||
20 | |||
21 | //############################################################################ |
||
22 | //ISR, die bei einem Ereignis auf dem Bus ausgelöst wird. Im Register TWSR befindet |
||
23 | //sich dann ein Statuscode, anhand dessen die Situation festgestellt werden kann. |
||
24 | ISR (TWI_vect) |
||
25 | //############################################################################ |
||
26 | { |
||
27 | switch (TWSR & 0xF8) |
||
28 | { |
||
29 | case SR_SLA_ACK: |
||
30 | TWCR |= (1<<TWINT); |
||
31 | Byte_Counter=0; |
||
32 | return; |
||
33 | // Daten Empfangen |
||
34 | case SR_PREV_ACK: |
||
35 | I2C_RXBuffer = TWDR; |
||
36 | I2C_Timeout = 500; |
||
37 | TWCR |= (1<<TWINT); |
||
38 | return; |
||
39 | // Daten Senden |
||
40 | case SW_SLA_ACK: |
||
41 | if (Byte_Counter==0) |
||
42 | { |
||
43 | TWDR = Mittelstrom; |
||
44 | Byte_Counter++; |
||
45 | } |
||
46 | else |
||
47 | { |
||
48 | TWDR = MaxPWM; |
||
49 | } |
||
50 | TWCR |= (1<<TWINT); |
||
51 | return; |
||
52 | // Daten Senden |
||
53 | case SW_DATA_ACK: |
||
54 | if (Byte_Counter==0) |
||
55 | { |
||
56 | TWDR = Mittelstrom; |
||
57 | Byte_Counter++; |
||
58 | } |
||
59 | else |
||
60 | { |
||
61 | TWDR = MaxPWM; |
||
62 | } |
||
63 | TWCR |= (1<<TWINT); |
||
64 | return; |
||
65 | // Bus-Fehler zurücksetzen |
||
66 | case TWI_BUS_ERR_2: |
||
67 | TWCR |=(1<<TWSTO) | (1<<TWINT); |
||
68 | // Bus-Fehler zurücksetzen |
||
69 | case TWI_BUS_ERR_1: |
||
70 | TWCR |=(1<<TWSTO) | (1<<TWINT); |
||
71 | } |
||
72 | TWCR =(1<<TWEA) | (1<<TWINT) | (1<<TWEN) | (1<<TWIE); // TWI Reset |
||
73 | } |
||
74 | |||
75 |