-
Notifications
You must be signed in to change notification settings - Fork 59
Expand file tree
/
Copy pathuArmRecorder.cpp
More file actions
61 lines (52 loc) · 1.79 KB
/
uArmRecorder.cpp
File metadata and controls
61 lines (52 loc) · 1.79 KB
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
/**
******************************************************************************
* @file uArmRecorder.cpp
* @author David.Long
* @email xiaokun.long@ufactory.cc
* @date 2016-09-30
* @license GNU
* copyright(c) 2016 UFactory Team. All right reserved
******************************************************************************
*/
#include "uArmRecorder.h"
uArmRecorder recorder;
extern void reportPos();
uArmRecorder::uArmRecorder()
{
}
void uArmRecorder::write(unsigned int addr, unsigned char data[], int num)
{
unsigned char i=0;
i = (addr % 128);
// Since the eeprom's sector is 128 byte, if we want to write 5 bytes per cycle we need to care about when there's less than 5 bytes left
if((i >= 124) && (num == 5))
{
i = 128 - i;
iic_writebuf(data, EXTERNAL_EEPROM_USER_ADDRESS, addr, i);// write data
delay(5);
iic_writebuf(data + i, EXTERNAL_EEPROM_USER_ADDRESS, addr + i, num - i);// write data
}
//if the left bytes are greater than 5, just do it
else
{
iic_writebuf(data, EXTERNAL_EEPROM_USER_ADDRESS, addr, num);// write data
}
}
void uArmRecorder::read(unsigned int addr, unsigned char data[], int num)
{
unsigned char i=0;
i= (addr % 128);
// Since the eeprom's sector is 128 byte, if we want to write 5 bytes per cycle we need to care about when there's less than 5 bytes left
if( (i >= 124) && (num == 5))
{
i = 128 - i;
iic_readbuf(data, EXTERNAL_EEPROM_USER_ADDRESS, addr, i);// write data
delay(5);
iic_readbuf(data + i, EXTERNAL_EEPROM_USER_ADDRESS, addr + i, num - i);// write data
}
//if the left bytes are greater than 5, just do it
else
{
iic_readbuf(data, EXTERNAL_EEPROM_USER_ADDRESS, addr, num);// write data
}
}