blob: fe5b37b192458b2727e1b0a56985c81370c3888f (
plain)
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
|
#include "driver/i2c.h"
#include "arch.h"
#include <msp430.h>
#ifndef F_I2C
#define F_I2C 100000
#endif
volatile unsigned short old_ifg = 0;
#if (F_CPU / F_I2C) < 45
inline void await_i2c_int(unsigned int ie_flags, unsigned int ifg_flags) {
while (!(UCB0IFG & ifg_flags)) ;
if (UCB0IFG & (UCNACKIFG | UCCLTOIFG)) {
UCB0IFG &= ~(UCNACKIFG | UCCLTOIFG);
}
}
#else
inline void await_i2c_int(unsigned int ie_flags, unsigned int ifg_flags)
{
UCB0IFG = 0;
old_ifg = 0;
UCB0IE = ie_flags;
do {
arch.idle();
} while (!(old_ifg & ifg_flags));
UCB0IE = 0;
}
#endif
signed char I2C::setup()
{
#ifdef I2C_PULLUP_FIXED_GPIO
P1DIR |= BIT4 | BIT5;
P1OUT |= BIT4 | BIT5;
#endif
UCB0CTL1 = UCSWRST;
UCB0CTLW0 = UCMODE_3 | UCMST | UCSYNC | UCSSEL_2 | UCSWRST | UCCLTO_1;
UCB0BRW = (F_CPU / F_I2C) - 1;
P1DIR &= ~(BIT6 | BIT7);
P1SEL0 &= ~(BIT6 | BIT7);
P1SEL1 |= BIT6 | BIT7;
UCB0CTL1 &= ~UCSWRST;
UCB0I2CSA = 0;
arch.delay_us(100);
if (UCB0STAT & UCBBUSY)
return -1;
return 0;
}
void I2C::scan(unsigned int *results)
{
for (unsigned char address = 0; address < 128; address++) {
UCB0I2CSA = address;
UCB0CTL1 |= UCTR | UCTXSTT | UCTXSTP;
while (UCB0CTL1 & UCTXSTP);
if (UCB0IFG & UCNACKIFG) {
UCB0IFG &= ~UCNACKIFG;
} else {
results[address / (8 * sizeof(unsigned int))] |= 1 << (address % (8 * sizeof(unsigned int)));
}
}
UCB0IFG = 0;
}
signed char I2C::xmit(unsigned char address,
unsigned char tx_len, unsigned char *tx_buf,
unsigned char rx_len, unsigned char *rx_buf)
{
unsigned char i;
UCB0I2CSA = address;
if (tx_len) {
UCB0CTL1 |= UCTR | UCTXSTT;
for (i = 0; i < tx_len; i++) {
await_i2c_int(UCTXIE0 | UCNACKIE | UCCLTOIE, UCTXIFG0 | UCNACKIFG | UCCLTOIFG);
if (old_ifg & (UCNACKIFG | UCCLTOIFG)) {
UCB0CTL1 |= UCTXSTP;
return -1;
}
old_ifg = 0;
UCB0TXBUF = tx_buf[i];
}
await_i2c_int(UCTXIE0 | UCNACKIE | UCCLTOIE, UCTXIFG0 | UCNACKIFG | UCCLTOIFG);
//if (UCB0IFG & (UCNACKIFG | UCCLTOIFG)) {
// UCB0IFG &= ~UCNACKIFG;
// UCB0IFG &= ~UCCLTOIFG;
// UCB0CTL1 |= UCTXSTP;
// return -1;
//}
}
if (rx_len) {
UCB0I2CSA = address;
UCB0IFG = 0;
UCB0CTL1 &= ~UCTR;
UCB0CTL1 |= UCTXSTT;
while (UCB0CTL1 & UCTXSTT);
UCB0IFG &= ~UCTXIFG0;
for (i = 0; i < rx_len; i++) {
if (i == rx_len - 1)
UCB0CTL1 |= UCTXSTP;
await_i2c_int(UCRXIE | UCNACKIE | UCCLTOIE, UCRXIFG0 | UCNACKIFG | UCCLTOIFG);
rx_buf[i] = UCB0RXBUF;
UCB0IFG &= ~UCRXIFG0;
}
UCB0IFG &= ~UCRXIFG0;
}
UCB0CTL1 |= UCTXSTP;
while (UCB0CTL1 & UCTXSTP);
return 0;
}
__attribute__((interrupt(USCI_B0_VECTOR))) __attribute__((wakeup)) void handle_usci_b0()
{
old_ifg = UCB0IFG;
UCB0IFG = 0;
}
I2C i2c;
|
