static inline int __stm_trace(uint32_t options, uint8_t entity_id, uint8_t proto_id, const void *data, uint32_t size) { struct stm_drvdata *drvdata = stmdrvdata; int len = 0; uint32_t ch; unsigned long ch_addr; /* Allocate channel and get the channel address */ ch = stm_channel_alloc(0); ch_addr = (unsigned long)stm_channel_addr(drvdata, ch); /* Send the ost header */ len += stm_trace_ost_header(ch_addr, options, entity_id, proto_id, data, size); /* Send the payload data */ len += stm_trace_data(ch_addr, options, data, size); /* Send the ost tail */ len += stm_trace_ost_tail(ch_addr, options); /* We are done, free the channel */ stm_channel_free(ch); return len; }
static ssize_t notrace stm_generic_packet(struct stm_data *stm_data, unsigned int master, unsigned int channel, unsigned int packet, unsigned int flags, unsigned int size, const unsigned char *payload) { void __iomem *ch_addr; struct stm_drvdata *drvdata = container_of(stm_data, struct stm_drvdata, stm); if (!(drvdata && local_read(&drvdata->mode))) return -EACCES; if (channel >= drvdata->numsp) return -EINVAL; ch_addr = stm_channel_addr(drvdata, channel); flags = (flags == STP_PACKET_TIMESTAMPED) ? STM_FLAG_TIMESTAMPED : 0; flags |= test_bit(channel, drvdata->chs.guaranteed) ? STM_FLAG_GUARANTEED : 0; if (size > drvdata->write_bytes) size = drvdata->write_bytes; else size = rounddown_pow_of_two(size); switch (packet) { case STP_PACKET_FLAG: ch_addr += stm_channel_off(STM_PKT_TYPE_FLAG, flags); /* * The generic STM core sets a size of '0' on flag packets. * As such send a flag packet of size '1' and tell the * core we did so. */ stm_send(ch_addr, payload, 1, drvdata->write_bytes); size = 1; break; case STP_PACKET_DATA: ch_addr += stm_channel_off(STM_PKT_TYPE_DATA, flags); stm_send(ch_addr, payload, size, drvdata->write_bytes); break; default: return -ENOTSUPP; } return size; }
static inline int __stm_trace(uint32_t options, uint8_t entity_id, uint8_t proto_id, const void *data, uint32_t size) { struct stm_drvdata *drvdata = stmdrvdata; int len = 0; uint32_t ch; unsigned long ch_addr; /* */ ch = stm_channel_alloc(0); ch_addr = (unsigned long)stm_channel_addr(drvdata, ch); if (drvdata->write_64bit) { /* */ len += stm_trace_ost_header_64bit(ch_addr, options, entity_id, proto_id, data, size); /* */ len += stm_trace_data_64bit(ch_addr, options, data, size); /* */ len += stm_trace_ost_tail_64bit(ch_addr, options); } else { /* */ len += stm_trace_ost_header(ch_addr, options, entity_id, proto_id, data, size); /* */ len += stm_trace_data(ch_addr, options, data, size); /* */ len += stm_trace_ost_tail(ch_addr, options); } /* */ stm_channel_free(ch); return len; }