Subversion Repositories FlightCtrl

Rev

Rev 1596 | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1 ingob 1
/*############################################################################
2
############################################################################*/
3
 
4
#include "main.h"
5
 
918 hbuss 6
volatile unsigned char twi_state = 0;
1 ingob 7
unsigned char motor = 0;
1210 hbuss 8
unsigned char motorread = 0,MissingMotor = 0;
1479 killagreg 9
 
10
MotorData_t Motor[MAX_MOTORS];
11
 
1322 hbuss 12
unsigned int I2CError = 0;
1 ingob 13
 
14
//############################################################################
15
//Initzialisieren der I2C (TWI) Schnittstelle
16
void i2c_init(void)
17
//############################################################################
18
{
19
  TWSR = 0;
1479 killagreg 20
  TWBR = ((SYSCLK/SCL_CLOCK)-16)/2;
1 ingob 21
}
22
 
23
//############################################################################
24
//Start I2C
1479 killagreg 25
void i2c_start(void)
1 ingob 26
//############################################################################
27
{
28
    TWCR = (1<<TWSTA) | (1<<TWEN) | (1<<TWINT) | (1<<TWIE);
29
}
30
 
31
//############################################################################
32
void i2c_stop(void)
33
//############################################################################
34
{
35
    TWCR = (1<<TWEN) | (1<<TWSTO) | (1<<TWINT);
36
}
37
 
173 holgerb 38
void i2c_reset(void)
1 ingob 39
//############################################################################
173 holgerb 40
{
1479 killagreg 41
                 i2c_stop();
173 holgerb 42
                 twi_state = 0;
43
                 motor = TWDR;
44
                 motor = 0;
45
                 TWCR = 0x80;
46
                 TWAMR = 0;
47
                 TWAR = 0;
48
                 TWDR = 0;
49
                 TWSR = 0;
50
                 TWBR = 0;
51
                 i2c_init();
52
                 i2c_start();
53
                 i2c_write_byte(0);
54
}
55
 
56
//############################################################################
1209 hbuss 57
void i2c_write_byte(char byte)
1 ingob 58
//############################################################################
1479 killagreg 59
{
1 ingob 60
    TWSR = 0x00;
61
    TWDR = byte;
62
    TWCR = (1<<TWINT) | (1<<TWEN) | (1<<TWIE);
63
}
64
 
1209 hbuss 65
/****************************************/
66
/*    Write to I2C                      */
67
/****************************************/
68
void I2C_WriteByte(int8_t byte)
69
{
70
    // move byte to send into TWI Data Register
71
    TWDR = byte;
72
    // clear interrupt flag (TWINT = 1)
73
    // enable i2c bus (TWEN = 1)
74
    // enable interrupt (TWIE = 1)
75
    TWCR = (1<<TWINT) | (1<<TWEN) | (1<<TWIE);
76
}
77
 
78
/****************************************/
79
/*    Receive byte and send ACK         */
80
/****************************************/
81
void I2C_ReceiveByte(void)
82
{
83
   TWCR = (1<<TWINT) | (1<<TWEN) | (1<<TWIE) | (1<<TWEA);
84
}
85
 
86
/****************************************/
87
/* I2C receive last byte and send no ACK*/
88
/****************************************/
89
void I2C_ReceiveLastByte(void)
90
{
91
   TWCR = (1<<TWINT) | (1<<TWEN) | (1<<TWIE);
92
}
93
 
94
 
95
 
1 ingob 96
//############################################################################
97
SIGNAL (TWI_vect)
98
//############################################################################
99
{
1211 hbuss 100
 static unsigned char missing_motor;
1210 hbuss 101
     switch(twi_state++)
1 ingob 102
        {
1210 hbuss 103
//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
104
// Writing the Data
105
//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
1 ingob 106
        case 0:
1210 hbuss 107
                        while(Mixer.Motor[motor][0] <= 0 && motor < MAX_MOTORS) motor++;  // skip if not used
1479 killagreg 108
                                if(motor == MAX_MOTORS)  // writing finished -> now read
109
                                {
110
                                 motor = 0;
111
                                 twi_state = 3;
1210 hbuss 112
                                 i2c_write_byte(0x53+(motorread*2));
1479 killagreg 113
                                 }
1209 hbuss 114
                                else i2c_write_byte(0x52+(motor*2));
1 ingob 115
                break;
116
        case 1:
1479 killagreg 117
                i2c_write_byte(Motor[motor++].SetPoint);
1111 hbuss 118
                break;
119
        case 2:
1479 killagreg 120
                if(TWSR == 0x30)
121
                                 {
122
                                  if(!missing_motor) missing_motor = motor;
123
                                  if((Motor[motor-1].State & MOTOR_STATE_ERROR_MASK) < MOTOR_STATE_ERROR_MASK) Motor[motor-1].State++; // increment error counter and handle overflow
1322 hbuss 124
                                 }
1111 hbuss 125
                i2c_stop();
1210 hbuss 126
                I2CTimeout = 10;
1209 hbuss 127
                twi_state = 0;
1479 killagreg 128
                i2c_start();
129
                break;
1210 hbuss 130
//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
131
// Reading Data
132
//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
1111 hbuss 133
        case 3:
1211 hbuss 134
               //Transmit 1st byte for reading
1210 hbuss 135
                if(TWSR != 0x40)  // Error?
1479 killagreg 136
                 {
137
                  Motor[motorread].State &= ~MOTOR_STATE_PRESENT_MASK; // clear present bit
138
                  motorread++;
1211 hbuss 139
                  if(motorread >= MAX_MOTORS) motorread = 0;
140
                  i2c_stop();
1210 hbuss 141
                  twi_state = 0;
142
                 }
1479 killagreg 143
                 else
1211 hbuss 144
                 {
1479 killagreg 145
                  Motor[motorread].State |= MOTOR_STATE_PRESENT_MASK; // set present bit
1211 hbuss 146
                  I2C_ReceiveByte();
147
                 }
1210 hbuss 148
                MissingMotor = missing_motor;
1211 hbuss 149
                missing_motor = 0;
1111 hbuss 150
                break;
1210 hbuss 151
        case 4: //Read 1st byte and transmit 2nd Byte
1479 killagreg 152
                Motor[motorread].Current = TWDR;
1209 hbuss 153
                I2C_ReceiveLastByte(); //nack
154
                break;
1210 hbuss 155
        case 5:
1209 hbuss 156
                //Read 2nd byte
1479 killagreg 157
                Motor[motorread].MaxPWM = TWDR;
158
                                motorread++; // next motor
1211 hbuss 159
                if(motorread >= MAX_MOTORS) motorread = 0;
1111 hbuss 160
                i2c_stop();
1209 hbuss 161
                twi_state = 0;
1111 hbuss 162
                break;
1479 killagreg 163
 
1210 hbuss 164
//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
165
// writing Gyro-Offset
166
//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
1479 killagreg 167
        case 8:
1111 hbuss 168
                i2c_write_byte(0x98); // Address of the DAC
169
                break;
1479 killagreg 170
        case 9:
1111 hbuss 171
                i2c_write_byte(0x10); // Update Channel A
172
                break;
1479 killagreg 173
        case 10:
1111 hbuss 174
                i2c_write_byte(AnalogOffsetNick); // Value
175
                break;
1479 killagreg 176
        case 11:
1111 hbuss 177
                i2c_write_byte(0x80); // Value
178
                break;
1479 killagreg 179
        case 12:
180
                i2c_stop();
1111 hbuss 181
                I2CTimeout = 10;
1479 killagreg 182
                i2c_start();
1111 hbuss 183
                break;
1479 killagreg 184
        case 13:
1111 hbuss 185
                i2c_write_byte(0x98); // Address of the DAC
186
                break;
1479 killagreg 187
        case 14:
1111 hbuss 188
                i2c_write_byte(0x12); // Update Channel B
189
                break;
1479 killagreg 190
        case 15:
1111 hbuss 191
                i2c_write_byte(AnalogOffsetRoll); // Value
192
                break;
1479 killagreg 193
        case 16:
1111 hbuss 194
                i2c_write_byte(0x80); // Value
195
                break;
1479 killagreg 196
        case 17:
197
                i2c_stop();
1111 hbuss 198
                I2CTimeout = 10;
1479 killagreg 199
                i2c_start();
1111 hbuss 200
                break;
1479 killagreg 201
        case 18:
1111 hbuss 202
                i2c_write_byte(0x98); // Address of the DAC
203
                break;
1479 killagreg 204
        case 19:
1111 hbuss 205
                i2c_write_byte(0x14); // Update Channel C
206
                break;
1479 killagreg 207
        case 20:
1111 hbuss 208
                i2c_write_byte(AnalogOffsetGier); // Value
209
                break;
1479 killagreg 210
        case 21:
1111 hbuss 211
                i2c_write_byte(0x80); // Value
212
                break;
1479 killagreg 213
        case 22:
214
                i2c_stop();
1111 hbuss 215
                I2CTimeout = 10;
216
                twi_state = 0;
217
                break;
1209 hbuss 218
        default: twi_state = 0;
1479 killagreg 219
                break;
1209 hbuss 220
                }
1111 hbuss 221
 TWCR |= 0x80;
222
}