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;
}