forked from Traumflug/Teacup_Firmware
-
Notifications
You must be signed in to change notification settings - Fork 1
/
i2c.c
526 lines (449 loc) · 16.7 KB
/
i2c.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523
524
525
526
/** \file
\brief I2C / TWI subsystem
"TWI", "Two Wire Interface", is Atmel's name for the (patented) I2C bus
system. I2C is technically pretty sophisticated, it also takes the current
state of these two wires as part of the protocol into account. Like SPI it's
a master/slave system with a clock signal on the wire. Unlike SPI,
communication partners aren't choosen by setting a pin, but by by
transferring an address byte before the actual data.
Accordingly, code has to deal with states, transmissions have a start and
an end, and actions on the bus can result in different states, like success
or failure.
avr-libc comes with good sample code:
http://www.nongnu.org/avr-libc/examples/twitest/twitest.c
For technical details see section 22 of atmega328 datasheet.
*/
#include "i2c.h"
#ifdef I2C
#include <avr/io.h>
#include <avr/interrupt.h>
#include <util/twi.h>
#include "delay.h"
#include "pinio.h"
#include "memory_barrier.h"
#if defined I2C_MASTER_MODE && defined I2C_SLAVE_MODE
#error Cant be I2C master and slave at the same time.
#endif
#if defined I2C_SLAVE_MODE || defined I2C_READ_SUPPORT || \
defined I2C_EEPROM_SUPPORT
#warning These portions of the code are untested and need work.
#endif
#ifdef I2C_SLAVE_MODE
#define I2C_MODE 1
#else
#define I2C_MODE 0
#endif
#define I2C_MODE_MASK 0b00001100
// Start-Addr_R-Read-Stop: just read mode.
#define I2C_MODE_SARP 0b00000000
// Start-Addr_W-Write-Stop: just write mode.
#define I2C_MODE_SAWP 0b00000100
// Start-Addr_W-WrPageAdr-rStart-Addr_R-Read-Stop.
#define I2C_MODE_ENHA 0b00001000
// Transponder is busy.
#define I2C_MODE_BUSY 0b01000000
// Transmission interrupted.
#define I2C_INTERRUPTED 0b10000000
#define I2C_ERROR 0b00000001
#define I2C_ERROR_LOW_PRIO 0b00100000
// Address of the device that is communicated with.
uint8_t i2c_address;
// State of TWI component of MCU.
volatile uint8_t i2c_state = 0;
/**
Wether transmission should be terminated on buffer drain. This also means
no new bytes get stuffed into the buffer until this drain happened. It's
used to allow distinct transmissions.
*/
volatile uint8_t i2c_should_end = 0;
#ifdef I2C_EEPROM_SUPPORT
// For SAWSARP mode (see ENHA in i2c.h).
uint8_t i2c_page_address[I2C_PAGE_ADDRESS_SIZE];
// Index into the page address buffer.
uint8_t i2c_page_index;
// Count of bytes in page address.
uint8_t i2c_page_count;
#endif /* I2C_EEPROM_SUPPORT */
#ifdef I2C_SLAVE_MODE
uint8_t i2c_in_buffer[I2C_SLAVE_RX_BUFFER_SIZE];
uint8_t i2c_out_buffer[I2C_SLAVE_TX_BUFFER_SIZE];
#endif /* I2C_SLAVE_MODE */
// Ringbuffer logic for buffer 'send'.
#define BUFSIZE I2C_BUFFER_SIZE
volatile uint8_t sendhead = 0;
volatile uint8_t sendtail = 0;
volatile uint8_t sendbuf[BUFSIZE];
#include "ringbuffer.h"
/**
Inititalise the I2C/TWI subsystem.
\param address Address the system should listen to in slave mode, unused
when configured for master mode. In master mode, receiver
address is given to the send command.
This also sets the I2C address. In slave mode it's the address we listen on.
In master mode it's the communication target address. As master one can talk
to different devices. Call again i2c_init() for changing the target address,
then. Doing so won't interrupt ongoing transmissions and overhead is small.
*/
void i2c_init(uint8_t address) {
// In case this is a re-inititalisation,
// don't interrupt an ongoing transmission.
while (i2c_state & I2C_MODE_BUSY) {
delay_us(10);
}
i2c_address = address;
#ifdef I2C_MASTER_MODE
#ifdef I2C_ENABLE_PULLUPS
SET_INPUT(SCL);
PULLUP_ON(SCL);
SET_INPUT(SDA);
PULLUP_ON(SDA);
#endif /* I2C_ENABLE_PULLUPS */
/**
TWI Bit Rate register
SCL_freq = CPU_freq / (16 + 2 * TWBR)
See: page 235 of atmega328 datasheet.
*/
TWBR = ((F_CPU / I2C_BITRATE) - 16) / 2;
/**
TWI Status Register
Lower two bits set the prescaler value.
See: page 236 of atmega328 datasheet.
*/
TWSR = 0x00;
#endif /* I2C_MASTER_MODE */
#ifdef I2C_SLAVE_MODE
TWAR = i2c_address; // We listen to broadcasts if lowest bit is set.
TWCR = (0<<TWINT)|(0<<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
#endif
}
/**
Report wether I2C is busy.
\return Wether I2C is currently busy, which means that eventual new
transactions would have to wait.
Idea is that non-crucial display writes check the bus before actually
writing, so they avoid long waits. If i2c_busy() returns zero, the bus
is free and writes won't cause a delay.
*/
uint8_t i2c_busy(void) {
return (i2c_state & I2C_MODE_BUSY);
}
/**
Send a byte to the I2C partner.
\param data The byte to be buffered/sent.
\param last_byte Wether this is the last byte of a transmission.
This implementation assumes to talk to mostly one communications client. To
set the target, or to change it between transmissions, call i2c_init().
Unlike many other protocols (serial, SPI), I2C has an explicite transmission
start and transmission end. Invoking code has to tell wether the given byte
is the last byte of a transmission, so sending code can properly end it.
This function has been tested to properly distinguish between individual
transmissions separated by last_byte. Other than setting this flag, invoking
code doesn't have to care about distinction, but may experience substantial
delays (up to several milliseconds) if the bus is already busy with a
distinct previous transmission.
Data is buffered, so this returns quickly for small amounts of data. Large
amounts don't get lost, but this function has to wait until sufficient
previous data was sent.
To avoid unexpected delays, invoking code can check for bus availability
with i2c_busy().
Note that calling code has to send bytes quickly enough to not drain the
buffer. It looks like the I2C protocol doesn't, unlike e.g. SPI, allow
to pause sending without dropping the transmission. Positive of this
limitation is, one can end a transmisson by simply not writing for a while,
until it's sure the buffer became empty.
*/
void i2c_write(uint8_t data, uint8_t last_byte) {
// Drop characters until transmission end. Transmissions to the display
// start with a command byte, so sending truncated transmissions is harmful.
if (i2c_state & I2C_ERROR) {
if (last_byte) {
i2c_state &= ~I2C_ERROR;
}
return;
}
while (i2c_should_end || ! buf_canwrite(send)) {
delay_us(10);
}
if ( ! (i2c_state & I2C_MODE_BUSY)) {
// No transmission ongoing, start one.
i2c_state = I2C_MODE_SAWP;
TWCR = (1<<TWINT)|(0<<TWEA)|(1<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
i2c_state |= I2C_MODE_BUSY;
}
ATOMIC_START
buf_push(send, data);
i2c_should_end = last_byte;
ATOMIC_END
}
/**
This is the interrupt for all the I2C things.
A few words about TWCR bits:
Bit 7 (TWINT) is used to run TWI.
Bit 6 (TWEA) is used to send ACK (if set) in cases of
a) device's own slave address has been received;
b) general call has been received;
c) a data byte has been received.
Bit 5 (TWSTA) is 1 if app wants to be a master, don't forget to
clear this bit.
Bit 4 (TWSTO) is generated STOP in master mode if set (cleared
automaticly), recovered from error condition in slave
mode if set.
Bit 3 (TWWC) is write collision flag. Sets on try to writeto TWDR when
TWINT is low.
Bit 2 (TWEN) activates SDA/SCL pins if set. Set to 0 to disable TWI.
Bit 1 (Reserved).
Bit 0 (TWIE) enables TWI interrupt.
*/
//#define TWI_INTERRUPT_DEBUG
#ifdef TWI_INTERRUPT_DEBUG
#include "serial.h"
#include "sendf.h"
#endif
ISR(TWI_vect) {
uint8_t status = TWSR & TW_STATUS_MASK;
#ifdef TWI_INTERRUPT_DEBUG
serial_writechar('.');
#endif
switch (status) {
case TW_START:
// Start happens, send a target address.
#ifdef TWI_INTERRUPT_DEBUG
serial_writechar('1');
#endif
if ((i2c_state & I2C_MODE_MASK) == I2C_MODE_SARP) {
i2c_address |= 0x01;
} else {
i2c_address &= 0xFE;
}
TWDR = i2c_address;
TWCR = (1<<TWINT)|(I2C_MODE<<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
break;
case TW_REP_START:
// Start happens, send a target address.
#ifdef TWI_INTERRUPT_DEBUG
serial_writechar('2');
#endif
if ((i2c_state & I2C_MODE_MASK) == I2C_MODE_ENHA) {
i2c_address |= 0x01;
} else {
i2c_address &= 0xFE;
}
TWDR = i2c_address;
TWCR = (1<<TWINT)|(I2C_MODE<<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
break;
case TW_MT_SLA_ACK:
// SLA+W was sent, then ACK received.
#ifdef TWI_INTERRUPT_DEBUG
serial_writechar('3');
#endif
if ((i2c_state & I2C_MODE_MASK) == I2C_MODE_SAWP && buf_canread(send)) {
buf_pop(send, TWDR);
TWCR = (1<<TWINT)|(I2C_MODE<<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
}
#ifdef I2C_EEPROM_SUPPORT
if ((i2c_state & I2C_MODE_MASK) == I2C_MODE_ENHA) {
TWDR = i2c_page_address[i2c_page_index++];
TWCR = (1<<TWINT)|(I2C_MODE<<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
}
#endif
break;
case TW_MT_DATA_ACK:
// A byte was sent, got ACK.
#ifdef TWI_INTERRUPT_DEBUG
serial_writechar('4');
#endif
if ((i2c_state & I2C_MODE_MASK) == I2C_MODE_SAWP) {
if (buf_canread(send)) {
// Send the next byte.
buf_pop(send, TWDR);
TWCR = (1<<TWINT)|(I2C_MODE<<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
} else {
// Buffer drained because transmission is completed.
i2c_state = 0;
i2c_should_end = 0;
// Send stop condition.
TWCR = (1<<TWINT)|(I2C_MODE<<TWEA)|(0<<TWSTA)|(1<<TWSTO)|(1<<TWEN)|(0<<TWIE);
}
}
#ifdef I2C_EEPROM_SUPPORT
if ((i2c_state & I2C_MODE_MASK) == I2C_MODE_ENHA) {
// It was a page address byte.
if (i2c_page_index == i2c_page_count) {
// It was the last byte of the page address.
TWCR = (1<<TWINT)|(I2C_MODE<<TWEA)|(1<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
} else {
// Send the next page address byte.
TWDR = i2c_page_address[i2c_page_index++];
TWCR = (1<<TWINT)|(I2C_MODE<<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
}
}
#endif
break;
#ifdef I2C_READ_SUPPORT
case TW_MR_SLA_ACK:
// SLA+R was sent, got АСК, then received a byte.
if (i2c_index + 1 == i2c_byte_count) {
// Last byte fitting into the buffer. Request a byte, then send NACK
// to slave and it will release the bus.
TWCR = (1<<TWINT)|(0<<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
} else {
// Or just receive a byte and sent ACK.
TWCR = (1<<TWINT)|(1<<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
}
break;
case TW_MR_SLA_NACK:
// SLA+R was sent, got NАСК, it seems the slave is busy.
i2c_state |= I2C_ERROR_NO_ANSWER;
// Send stop condition.
TWCR = (1<<TWINT)|(I2C_MODE<<TWEA)|(0<<TWSTA)|(1<<TWSTO)|(1<<TWEN)|(0<<TWIE);
break;
case TW_MR_DATA_ACK:
i2c_buffer[i2c_index++] = TWDR;
// TODO: Add BUFFER OVERFLOW check.
if (i2c_index + 1 == i2c_byte_count) {
// Last byte wait the processing.
TWCR = (1<<TWINT)|(0<<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
} else {
// Request the next byte.
TWCR = (1<<TWINT)|(0<<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
}
break;
case TW_MR_DATA_NACK:
// Last byte received, send NACK to make the slave to release the bus.
i2c_buffer[i2c_index] = TWDR;
// Send stop condition.
TWCR = (1<<TWINT)|(I2C_MODE<<TWEA)|(0<<TWSTA)|(1<<TWSTO)|(1<<TWEN)|(0<<TWIE);
break;
#endif /* I2C_READ_SUPPORT */
#ifdef I2C_SLAVE_MODE
case TW_SR_ARB_LOST_SLA_ACK:
case TW_SR_ARB_LOST_GCALL_ACK:
// Another master on the bus sent some bytes, receive them.
i2c_state |= I2C_ERROR_LOW_PRIO;
// Restore the transfer.
i2c_index = 0;
#ifdef I2C_EEPROM_SUPPORT
i2c_page_index = 0;
#endif
case TW_SR_SLA_ACK:
case TW_SR_GCALL_ACK:
i2c_state |= I2C_MODE_BUSY; // Lock bus.
i2c_index = 0;
if (I2C_SLAVE_RX_BUFFER_SIZE == 1) {
// We should take alone byte and send NACK.
TWCR = (1<<TWINT)|(0<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
} else {
// Get a byte and send ACK.
TWCR = (1<<TWINT)|(1<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
}
break;
case TW_SR_DATA_ACK:
case TW_SR_GCALL_DATA_ACK:
i2c_in_buffer[i2c_index++] = TWDR;
if (i2c_index == I2C_SLAVE_RX_BUFFER_SIZE - 1) {
// Room for only one byte left, send NACK.
TWCR = (1<<TWINT)|(0<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
} else {
// We have room for more bytes, send ACK.
TWCR = (1<<TWINT)|(1<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
}
break;
case TW_SR_DATA_NACK:
case TW_SR_GCALL_DATA_NACK:
i2c_in_buffer[i2c_index] = TWDR;
// Send stop condition.
TWCR = (1<<TWINT)|(I2C_MODE<<TWEA)|(0<<TWSTA)|(1<<TWSTO)|(1<<TWEN)|(0<<TWIE);
break;
case TW_SR_STOP:
// We got a Restart. What we will do?
// Here we can do additional logic but we don't need it at this time.
// Just ignore it now.
TWCR = (1<<TWINT)|(1<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
break;
case TW_ST_ARB_LOST_SLA_ACK:
// Got own address on read from another master.
i2c_state |= I2C_ERROR_LOW_PRIO | I2C_INTERRUPTED;
// Reinit.
i2c_index = 0;
#ifdef I2C_EEPROM_SUPPORT
i2c_page_index = 0;
#endif
case TW_ST_SLA_ACK:
// We have got own address on read.
i2c_index = 0;
TWDR = i2c_out_buffer[i2c_index];
if (I2C_SLAVE_TX_BUFFER_SIZE == 1) {
// If it is last byte, we hope to receive NACK.
TWCR = (1<<TWINT)|(0<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
} else {
// Wait for ACK.
TWCR = (1<<TWINT)|(1<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
}
break;
case TW_ST_DATA_ACK:
// Send byte and got ACK, then send next byte to master.
TWDR = i2c_out_buffer[++i2c_index];
if (I2C_SLAVE_TX_BUFFER_SIZE - 1 == i2c_index) {
// It was last byte, send it and wait for NACK.
TWCR = (1<<TWINT)|(0<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
} else {
// Send byte and wait for ACK.
TWCR = (1<<TWINT)|(1<TWEA)|(0<<TWSTA)|(0<<TWSTO)|(0<<TWEN)|(1<<TWIE);
}
break;
case TW_ST_DATA_NACK:
// We sent the last byte and received NACK or ACK (doesn't matter here).
if (i2c_state & I2C_INTERRUPTED) {
// There was interrupted master transfer.
i2c_state &= ~I2C_INTERRUPTED;
// Generate start as the bus became free.
TWCR = (1<<TWINT)|(1<TWEA)|(1<<TWSTA)|(0<<TWSTO)|(1<<TWEN)|(1<<TWIE);
} else {
// Send stop condition.
TWCR = (1<<TWINT)|(I2C_MODE<<TWEA)|(0<<TWSTA)|(1<<TWSTO)|(1<<TWEN)|(0<<TWIE);
}
break;
#endif /* I2C_SLAVE_MODE */
case TW_BUS_ERROR:
// A hardware error was detected.
#ifdef TWI_INTERRUPT_DEBUG
serial_writechar('5');
#endif
case TW_MT_SLA_NACK:
// SLA+W was sent, got NACK, so slave is busy or out of bus.
#ifdef TWI_INTERRUPT_DEBUG
serial_writechar('6');
#endif
case TW_MT_DATA_NACK:
// Byte was sent but got NACK, there are two possible reasons:
// - a slave stops transmission and it is ok, or
// - a slave became crazy.
#ifdef TWI_INTERRUPT_DEBUG
serial_writechar('7');
#endif
case TW_MT_ARB_LOST:
// Collision, identical to TW_MR_ARB_LOST.
// It looks like there is another master on the bus. Handle this like
// the other error conditions, because an eventual resend is handled in
// upper layers (display code).
#ifdef TWI_INTERRUPT_DEBUG
serial_writechar('8');
#endif
i2c_state |= I2C_ERROR | I2C_INTERRUPTED;
// Let i2c_write() continue.
i2c_should_end = 0;
// Drain the buffer.
while (buf_canread(send)) {
buf_pop(send, TWDR);
}
// Send stop condition.
TWCR = (1<<TWINT)|(I2C_MODE<<TWEA)|(0<<TWSTA)|(1<<TWSTO)|(1<<TWEN)|(0<<TWIE);
break;
default:
#ifdef TWI_INTERRUPT_DEBUG
sendf_P(serial_writechar, PSTR("(%sx)"), status);
#endif
break;
}
}
#endif /* I2C */