int32* NetEDIOQueryFunction(NetEDIO *ob,EDIOType type) { Stream *out = ob->out; int ret_len; int32* ret; WriteInt16LE(ob->out,0x000A); WriteInt8LE(ob->out,ob->instance); WriteInt8LE(ob->out,0x03); WriteInt32LE(ob->out,type); ob->out->Flush(ob->out); if (ob->conn->mode > 0) { while (ob->conn->count) { ob->conn->count--; ReadInt32LE(ob->in); } } if (ReadInt16LE(ob->in) != 0x000A) longjmp(ob->conn->exception,1); if (ReadInt8LE(ob->in) != 0x03) longjmp(ob->conn->exception,2); if (ReadInt8LE(ob->in) != 0x53) longjmp(ob->conn->exception,3); ret_len = ReadInt32LE(ob->in); ret = ArrayAlloc(ret_len,4); { int i; for(i=0;i<ret_len;i++) { ret[i] = ReadInt32LE(out); } } if (ReadInt8LE(ob->in) != 0x80) longjmp(ob->conn->exception,2); return ret; }
CANResult NetCANTx(NetCAN *ob,uint32 flags,uint32 id,const int8* data) { Stream *out = ob->out; int ret_len; CANResult ret; WriteInt16LE(ob->out,0x0007); WriteInt8LE(ob->out,ob->instance); WriteInt8LE(ob->out,0x01); WriteUInt32LE(ob->out,flags); WriteUInt32LE(ob->out,id); int i; WriteInt32LE(ob->out,ArrayLength(data)); for (i=0;i<ArrayLength(data);i++) { WriteInt8LE(ob->out,data[i]); } ob->out->Flush(ob->out); if (ob->conn->mode > 0) { while (ob->conn->count) { ob->conn->count--; ReadInt32LE(ob->in); } } if (ReadInt16LE(ob->in) != 0x0007) longjmp(ob->conn->exception,1); if (ReadInt8LE(ob->in) != 0x01) longjmp(ob->conn->exception,2); if (ReadInt8LE(ob->in) != 0xCB) longjmp(ob->conn->exception,3); ret = ReadInt32LE(out); if (ReadInt8LE(ob->in) != 0x80) longjmp(ob->conn->exception,2); return ret; }
void NetModeDec(NetMode *ob) { Stream *out = ob->out; int ret_len; WriteInt16LE(ob->out,0x000B); WriteInt8LE(ob->out,ob->instance); WriteInt8LE(ob->out,0x04); if (ob->conn->mode > 0) ob->conn->count++; if (ob->conn->mode < 2) ob->out->Flush(ob->out); if (ob->conn->mode > 0) return; if (ReadInt16LE(ob->in) != 0x000B) longjmp(ob->conn->exception,1); if (ReadInt8LE(ob->in) != 0x04) longjmp(ob->conn->exception,2); if (ReadInt8LE(ob->in) != 0x80) longjmp(ob->conn->exception,2); }
CANResult NetCANRxMulti(NetCAN *ob,CANMessage* msg,int32 min) { Stream *out = ob->out; int ret_len; CANResult ret; WriteInt16LE(ob->out,0x0007); WriteInt8LE(ob->out,ob->instance); WriteInt8LE(ob->out,0x05); WriteInt32LE(ob->out,ArrayLength(msg)); WriteInt32LE(ob->out,min); ob->out->Flush(ob->out); if (ob->conn->mode > 0) { while (ob->conn->count) { ob->conn->count--; ReadInt32LE(ob->in); } } if (ReadInt16LE(ob->in) != 0x0007) longjmp(ob->conn->exception,1); if (ReadInt8LE(ob->in) != 0x05) longjmp(ob->conn->exception,2); if (ReadInt8LE(ob->in) != 0xCB) longjmp(ob->conn->exception,3); ret = ReadInt32LE(out); if (ReadInt8LE(ob->in) != 0x74) longjmp(ob->conn->exception,3); if (ReadInt32LE(ob->in)!=ArrayLength(msg)) longjmp(ob->conn->exception,5); { int i; for(i=0;i<ArrayLength(msg);i++) { if (ReadInt8LE(ob->in) != 0x03) longjmp(ob->conn->exception,3); msg[i].flags = ReadUInt32LE(out); if (ReadInt8LE(ob->in) != 0x03) longjmp(ob->conn->exception,3); msg[i].id = ReadUInt32LE(out); if (ReadInt8LE(ob->in) != 0x03) longjmp(ob->conn->exception,3); msg[i].t_sec = ReadUInt32LE(out); if (ReadInt8LE(ob->in) != 0x03) longjmp(ob->conn->exception,3); msg[i].t_usec = ReadUInt32LE(out); if (ReadInt8LE(ob->in) != 0x03) longjmp(ob->conn->exception,3); msg[i].length = ReadUInt32LE(out); if (ReadInt8LE(ob->in) != 0x40) longjmp(ob->conn->exception,3); ReadInt32LE(out); { int k; for(k=0;k<8;k++) { msg[i].data[i] = ReadUInt8LE(out); } } } } if (ReadInt8LE(ob->in) != 0x80) longjmp(ob->conn->exception,2); return ret; }
void NetBusPeekStream(NetBus *ob,int32 address,int32 direction,int8* dest) { Stream *out = ob->out; int ret_len; WriteInt16LE(ob->out,0x0001); WriteInt8LE(ob->out,ob->instance); WriteInt8LE(ob->out,0x15); WriteInt32LE(ob->out,address); WriteInt32LE(ob->out,direction); WriteInt32LE(ob->out,ArrayLength(dest)); ob->out->Flush(ob->out); if (ob->conn->mode > 0) { while (ob->conn->count) { ob->conn->count--; ReadInt32LE(ob->in); } } if (ReadInt16LE(ob->in) != 0x0001) longjmp(ob->conn->exception,1); if (ReadUInt8LE(ob->in) != 0x15) longjmp(ob->conn->exception,2); if (ReadUInt8LE(ob->in) != 0x50) longjmp(ob->conn->exception,3); if (ReadInt32LE(ob->in)!=ArrayLength(dest)) longjmp(ob->conn->exception,5); { int i; for(i=0;i<ArrayLength(dest);i++) { dest[i] = ReadInt8LE(out); } } if (ReadUInt8LE(ob->in) != 0x80) longjmp(ob->conn->exception,2); }
int32 NetDIOGetMulti(NetDIO *ob,int8* state,int32 offset) { Stream *out = ob->out; int ret_len; int32 ret; WriteInt16LE(ob->out,0x0005); WriteInt8LE(ob->out,ob->instance); WriteInt8LE(ob->out,0x0C); WriteInt32LE(ob->out,ArrayLength(state)); WriteInt32LE(ob->out,offset); ob->out->Flush(ob->out); if (ob->conn->mode > 0) { while (ob->conn->count) { ob->conn->count--; ReadInt32LE(ob->in); } } if (ReadInt16LE(ob->in) != 0x0005) longjmp(ob->conn->exception,1); if (ReadUInt8LE(ob->in) != 0x0C) longjmp(ob->conn->exception,2); if (ReadUInt8LE(ob->in) != 0x13) longjmp(ob->conn->exception,3); ret = ReadInt32LE(out); if (ReadUInt8LE(ob->in) != 0x50) longjmp(ob->conn->exception,3); if (ReadInt32LE(ob->in)!=ArrayLength(state)) longjmp(ob->conn->exception,5); { int i; for(i=0;i<ArrayLength(state);i++) { state[i] = ReadInt8LE(out); } } if (ReadUInt8LE(ob->in) != 0x80) longjmp(ob->conn->exception,2); return ret; }
int32 NetAIOGets8(NetAIO *ob,int8* buf) { Stream *out = ob->out; int ret_len; int32 ret; WriteInt16LE(ob->out,0x0009); WriteInt8LE(ob->out,ob->instance); WriteInt8LE(ob->out,0x15); WriteInt32LE(ob->out,ArrayLength(buf)); ob->out->Flush(ob->out); if (ob->conn->mode > 0) { while (ob->conn->count) { ob->conn->count--; ReadInt32LE(ob->in); } } if (ReadInt16LE(ob->in) != 0x0009) longjmp(ob->conn->exception,1); if (ReadUInt8LE(ob->in) != 0x15) longjmp(ob->conn->exception,2); if (ReadUInt8LE(ob->in) != 0x13) longjmp(ob->conn->exception,3); ret = ReadInt32LE(out); if (ReadUInt8LE(ob->in) != 0x50) longjmp(ob->conn->exception,3); if (ReadInt32LE(ob->in)!=ArrayLength(buf)) longjmp(ob->conn->exception,5); { int i; for(i=0;i<ArrayLength(buf);i++) { buf[i] = ReadInt8LE(out); } } if (ReadUInt8LE(ob->in) != 0x80) longjmp(ob->conn->exception,2); return ret; }
int32 NetEDIOPreempt(NetEDIO *ob) { Stream *out = ob->out; int ret_len; int32 ret; WriteInt16LE(ob->out,0x000A); WriteInt8LE(ob->out,ob->instance); WriteInt8LE(ob->out,0x02); ob->out->Flush(ob->out); if (ob->conn->mode > 0) { while (ob->conn->count) { ob->conn->count--; ReadInt32LE(ob->in); } } if (ReadInt16LE(ob->in) != 0x000A) longjmp(ob->conn->exception,1); if (ReadInt8LE(ob->in) != 0x02) longjmp(ob->conn->exception,2); if (ReadInt8LE(ob->in) != 0x13) longjmp(ob->conn->exception,3); ret = ReadInt32LE(out); if (ReadInt8LE(ob->in) != 0x80) longjmp(ob->conn->exception,2); return ret; }
uint32 NetCANBaudGet(NetCAN *ob) { Stream *out = ob->out; int ret_len; uint32 ret; WriteInt16LE(ob->out,0x0007); WriteInt8LE(ob->out,ob->instance); WriteInt8LE(ob->out,0x03); ob->out->Flush(ob->out); if (ob->conn->mode > 0) { while (ob->conn->count) { ob->conn->count--; ReadInt32LE(ob->in); } } if (ReadInt16LE(ob->in) != 0x0007) longjmp(ob->conn->exception,1); if (ReadInt8LE(ob->in) != 0x03) longjmp(ob->conn->exception,2); if (ReadInt8LE(ob->in) != 0x03) longjmp(ob->conn->exception,3); ret = ReadUInt32LE(out); if (ReadInt8LE(ob->in) != 0x80) longjmp(ob->conn->exception,2); return ret; }
int32 NetEDIOQueryPWMfd(NetEDIO *ob,int32 num,uint32 freq[1],uint32 DC[1]) { Stream *out = ob->out; int ret_len; int32 ret; WriteInt16LE(ob->out,0x000A); WriteInt8LE(ob->out,ob->instance); WriteInt8LE(ob->out,0x07); WriteInt32LE(ob->out,num); ob->out->Flush(ob->out); if (ob->conn->mode > 0) { while (ob->conn->count) { ob->conn->count--; ReadInt32LE(ob->in); } } if (ReadInt16LE(ob->in) != 0x000A) longjmp(ob->conn->exception,1); if (ReadInt8LE(ob->in) != 0x07) longjmp(ob->conn->exception,2); if (ReadInt8LE(ob->in) != 0x13) longjmp(ob->conn->exception,3); ret = ReadInt32LE(out); if (ReadInt8LE(ob->in) != 0x43) longjmp(ob->conn->exception,3); ReadInt32LE(out); { int i; for(i=0;i<1;i++) { freq[i] = ReadUInt32LE(out); } } if (ReadInt8LE(ob->in) != 0x43) longjmp(ob->conn->exception,3); ReadInt32LE(out); { int i; for(i=0;i<1;i++) { DC[i] = ReadUInt32LE(out); } } if (ReadInt8LE(ob->in) != 0x80) longjmp(ob->conn->exception,2); return ret; }
int32 NetEDIOUnlock(NetEDIO *ob,uint32 num,int32 flags) { Stream *out = ob->out; int ret_len; int32 ret; WriteInt16LE(ob->out,0x000A); WriteInt8LE(ob->out,ob->instance); WriteInt8LE(ob->out,0x01); WriteUInt32LE(ob->out,num); WriteInt32LE(ob->out,flags); ob->out->Flush(ob->out); if (ob->conn->mode > 0) { while (ob->conn->count) { ob->conn->count--; ReadInt32LE(ob->in); } } if (ReadInt16LE(ob->in) != 0x000A) longjmp(ob->conn->exception,1); if (ReadInt8LE(ob->in) != 0x01) longjmp(ob->conn->exception,2); if (ReadInt8LE(ob->in) != 0x13) longjmp(ob->conn->exception,3); ret = ReadInt32LE(out); if (ReadInt8LE(ob->in) != 0x80) longjmp(ob->conn->exception,2); return ret; }
int32 NetEDIOHBridge(NetEDIO *ob,int32 num,HBState state) { Stream *out = ob->out; int ret_len; int32 ret; WriteInt16LE(ob->out,0x000A); WriteInt8LE(ob->out,ob->instance); WriteInt8LE(ob->out,0x0B); WriteInt32LE(ob->out,num); WriteInt32LE(ob->out,state); ob->out->Flush(ob->out); if (ob->conn->mode > 0) { while (ob->conn->count) { ob->conn->count--; ReadInt32LE(ob->in); } } if (ReadInt16LE(ob->in) != 0x000A) longjmp(ob->conn->exception,1); if (ReadInt8LE(ob->in) != 0x0B) longjmp(ob->conn->exception,2); if (ReadInt8LE(ob->in) != 0x13) longjmp(ob->conn->exception,3); ret = ReadInt32LE(out); if (ReadInt8LE(ob->in) != 0x80) longjmp(ob->conn->exception,2); return ret; }
uint32 NetEDIOEdgeCount(NetEDIO *ob,int32 num,int32 edge) { Stream *out = ob->out; int ret_len; uint32 ret; WriteInt16LE(ob->out,0x000A); WriteInt8LE(ob->out,ob->instance); WriteInt8LE(ob->out,0x09); WriteInt32LE(ob->out,num); WriteInt32LE(ob->out,edge); ob->out->Flush(ob->out); if (ob->conn->mode > 0) { while (ob->conn->count) { ob->conn->count--; ReadInt32LE(ob->in); } } if (ReadInt16LE(ob->in) != 0x000A) longjmp(ob->conn->exception,1); if (ReadInt8LE(ob->in) != 0x09) longjmp(ob->conn->exception,2); if (ReadInt8LE(ob->in) != 0x03) longjmp(ob->conn->exception,3); ret = ReadUInt32LE(out); if (ReadInt8LE(ob->in) != 0x80) longjmp(ob->conn->exception,2); return ret; }
int32 NetEDIOPWM(NetEDIO *ob,int32 num,uint32 periodHigh,uint32 periodLow) { Stream *out = ob->out; int ret_len; int32 ret; WriteInt16LE(ob->out,0x000A); WriteInt8LE(ob->out,ob->instance); WriteInt8LE(ob->out,0x04); WriteInt32LE(ob->out,num); WriteUInt32LE(ob->out,periodHigh); WriteUInt32LE(ob->out,periodLow); ob->out->Flush(ob->out); if (ob->conn->mode > 0) { while (ob->conn->count) { ob->conn->count--; ReadInt32LE(ob->in); } } if (ReadInt16LE(ob->in) != 0x000A) longjmp(ob->conn->exception,1); if (ReadInt8LE(ob->in) != 0x04) longjmp(ob->conn->exception,2); if (ReadInt8LE(ob->in) != 0x13) longjmp(ob->conn->exception,3); ret = ReadInt32LE(out); if (ReadInt8LE(ob->in) != 0x80) longjmp(ob->conn->exception,2); return ret; }