30 lines
1.4 KiB
C
30 lines
1.4 KiB
C
#include "modbus_data.h"
|
|
#include <assert.h>
|
|
#include <string.h>
|
|
int main(void)
|
|
{
|
|
uint16_t bank[4]={0xa5a5,0x5a5a,0x1234,0xbeef}, original[4], data[130], out;
|
|
unsigned offset, quantity, bit;
|
|
assert(mb_data_transfer(3,4,0,bank,0,data,130,&out)==0 && out==8 && data[3]==0xbeef);
|
|
assert(mb_data_transfer(16,4,7,bank,0,data,130,&out)==3);
|
|
assert(mb_data_validate(1,0,0,130)==3);
|
|
assert(mb_data_validate(3,126,0,130)==3);
|
|
assert(mb_data_validate(16,124,248,130)==3);
|
|
assert(mb_data_validate(15,17,3,1)==3);
|
|
assert(mb_data_validate(5,1,0,0)==3);
|
|
assert(mb_data_validate(2,1,0,130)==1);
|
|
for(offset=0;offset<16;++offset) for(quantity=1;quantity<=32;++quantity) {
|
|
bank[0]=0xa5a5; bank[1]=0x5a5a; bank[2]=0x1234; bank[3]=0xbeef;
|
|
memcpy(original,bank,sizeof(bank));
|
|
memset(data,0xcc,sizeof(data));
|
|
assert(mb_data_transfer(1,(uint16_t)quantity,0,bank,(uint16_t)offset,data,130,&out)==0);
|
|
for(bit=0;bit<quantity;++bit)
|
|
assert(((data[bit/16]>>((bit%16)^8))&1)==((bank[(bit+offset)/16]>>((bit+offset)%16))&1));
|
|
for(bit=0;bit<quantity;++bit) bank[(bit+offset)/16]^=(uint16_t)(1U<<((bit+offset)%16));
|
|
assert(mb_data_transfer(15,(uint16_t)quantity,out,bank,(uint16_t)offset,data,130,&out)==0);
|
|
assert(memcmp(bank,original,sizeof(bank))==0);
|
|
assert(data[(quantity+15)/16]==0xcccc); /* no write past response */
|
|
}
|
|
return 0;
|
|
}
|