luke
/
openFPGALoader
mirror of https://github.com/trabucayre/openFPGALoader.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

ftdipp_mpsse: mpsse_store: simplify and improve method

This commit is contained in:
Gwenhael Goavec-Merou 2020-01-15 08:15:15 +01:00
parent 9912628c44
commit b10f9c4e15
1 changed files with 23 additions and 14 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

37
ftdipp_mpsse.cpp
View File

@ -249,27 +249,36 @@ int FTDIpp_MPSSE::mpsse_store(unsigned char c)
int FTDIpp_MPSSE::mpsse_store(unsigned char *buff, int len)
{
unsigned char *ptr = buff;
/* this case theorically never happen */
if (len > _buffer_size) {
mpsse_write();
for (; len > _buffer_size; len -= _buffer_size) {
memcpy(_buffer, ptr, _buffer_size);
int store_size;
/* check if _buffer as space to store all */
if (_num + len > _buffer_size) {
/* flush buffer if already full */
if (_num == _buffer_size)
mpsse_write();
ptr += _buffer_size;
/* loop until loop < _buffer_size */
while (_num + len > _buffer_size) {
/* we now have len enough to fill
* buffer -> just complete buffer
*/
store_size = _buffer_size - _num;
memcpy(_buffer + _num, ptr, store_size);
_num += store_size;
if (mpsse_write() < 0) {
cout << "write_data error in " << __func__ << endl;
return -1;
}
ptr += store_size;
len -= store_size;
}
}
if (_num + len + 1 >= _buffer_size) {
if (mpsse_write() < 0) {
cout << "write_data error in " << __func__ << endl;
return -1;
}
}
#ifdef DEBUG
display("%s %d %d\n", __func__, _num, len);
#endif
memcpy(_buffer + _num, ptr, len);
_num += len;
if (len > 0) {
memcpy(_buffer + _num, ptr, len);
_num += len;
}
return 0;
}