int32_t getVelocity(int fd, uint8_t nodeId) { ZO_PROTOCOL_PACKET p; p.addressedNodeID = nodeId; p.ownNodeID = 0x01; p.commandID = 0x71; p.byteCount = 0x00; p.lrc = 0x71; if( putPacketSerial(fd, &p) ) { if( getResponse(fd, &p) ) return strToS32(p.data); else return -1; } else return -1; }
int32_t zoSms::getVelocity(uint8_t nodeId) { ZO_PROTOCOL_PACKET p; p.addressedNodeID = nodeId; p.ownNodeID = 1; p.commandID = 0x71; p.byteCount = 0; p.lrc = 0x71; if( ha.putPacket(&p) ) { if( getResponse(&p) ) return strToS32(p.data); else return -1; } else return -1; }