| 12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394 |
- // SPDX-License-Identifier: GPL-2.0
- /*
- * Copyright IBM Corp. 2016, 2023
- * Author(s): Martin Schwidefsky <schwidefsky@de.ibm.com>
- *
- * Adjunct processor bus, queue related code.
- */
- #define pr_fmt(fmt) "ap: " fmt
- #include <linux/export.h>
- #include <linux/init.h>
- #include <linux/slab.h>
- #include <asm/facility.h>
- #define CREATE_TRACE_POINTS
- #include <asm/trace/ap.h>
- #include "ap_bus.h"
- #include "ap_debug.h"
- EXPORT_TRACEPOINT_SYMBOL(s390_ap_nqap);
- EXPORT_TRACEPOINT_SYMBOL(s390_ap_dqap);
- static void __ap_flush_queue(struct ap_queue *aq);
- /*
- * some AP queue helper functions
- */
- static inline bool ap_q_supported_in_se(struct ap_queue *aq)
- {
- return aq->card->hwinfo.ep11 || aq->card->hwinfo.accel;
- }
- static inline bool ap_q_supports_bind(struct ap_queue *aq)
- {
- return aq->card->hwinfo.ep11 || aq->card->hwinfo.accel;
- }
- static inline bool ap_q_supports_assoc(struct ap_queue *aq)
- {
- return aq->card->hwinfo.ep11;
- }
- static inline bool ap_q_needs_bind(struct ap_queue *aq)
- {
- return ap_q_supports_bind(aq) && ap_sb_available();
- }
- /**
- * ap_queue_enable_irq(): Enable interrupt support on this AP queue.
- * @aq: The AP queue
- * @ind: the notification indicator byte
- *
- * Enables interruption on AP queue via ap_aqic(). Based on the return
- * value it waits a while and tests the AP queue if interrupts
- * have been switched on using ap_test_queue().
- */
- static int ap_queue_enable_irq(struct ap_queue *aq, void *ind)
- {
- union ap_qirq_ctrl qirqctrl = { .value = 0 };
- struct ap_queue_status status;
- qirqctrl.ir = 1;
- qirqctrl.isc = AP_ISC;
- status = ap_aqic(aq->qid, qirqctrl, virt_to_phys(ind));
- if (status.async)
- return -EPERM;
- switch (status.response_code) {
- case AP_RESPONSE_NORMAL:
- case AP_RESPONSE_OTHERWISE_CHANGED:
- return 0;
- case AP_RESPONSE_Q_NOT_AVAIL:
- case AP_RESPONSE_DECONFIGURED:
- case AP_RESPONSE_CHECKSTOPPED:
- case AP_RESPONSE_INVALID_ADDRESS:
- pr_err("Registering adapter interrupts for AP device %02x.%04x failed\n",
- AP_QID_CARD(aq->qid),
- AP_QID_QUEUE(aq->qid));
- return -EOPNOTSUPP;
- case AP_RESPONSE_RESET_IN_PROGRESS:
- case AP_RESPONSE_BUSY:
- default:
- return -EBUSY;
- }
- }
- /**
- * __ap_send(): Send message to adjunct processor queue.
- * @qid: The AP queue number
- * @psmid: The program supplied message identifier
- * @msg: The message text
- * @msglen: The message length
- * @special: Special Bit
- *
- * Returns AP queue status structure.
- * Condition code 1 on NQAP can't happen because the L bit is 1.
- * Condition code 2 on NQAP also means the send is incomplete,
- * because a segment boundary was reached. The NQAP is repeated.
- */
- static inline struct ap_queue_status
- __ap_send(ap_qid_t qid, unsigned long psmid, void *msg, size_t msglen,
- int special)
- {
- struct ap_queue_status status;
- if (special)
- qid |= 0x400000UL;
- status = ap_nqap(qid, psmid, msg, msglen);
- trace_s390_ap_nqap(AP_QID_CARD(qid), AP_QID_QUEUE(qid),
- status.value, psmid);
- return status;
- }
- /* State machine definitions and helpers */
- static enum ap_sm_wait ap_sm_nop(struct ap_queue *aq)
- {
- return AP_SM_WAIT_NONE;
- }
- /**
- * ap_sm_recv(): Receive pending reply messages from an AP queue but do
- * not change the state of the device.
- * @aq: pointer to the AP queue
- *
- * Returns AP_SM_WAIT_NONE, AP_SM_WAIT_AGAIN, or AP_SM_WAIT_INTERRUPT
- */
- static struct ap_queue_status ap_sm_recv(struct ap_queue *aq)
- {
- struct ap_queue_status status;
- struct ap_message *ap_msg;
- bool found = false;
- size_t reslen;
- unsigned long resgr0 = 0;
- int parts = 0;
- /*
- * DQAP loop until response code and resgr0 indicate that
- * the msg is totally received. As we use the very same buffer
- * the msg is overwritten with each invocation. That's intended
- * and the receiver of the msg is informed with a msg rc code
- * of EMSGSIZE in such a case.
- */
- do {
- status = ap_dqap(aq->qid, &aq->reply->psmid,
- aq->reply->msg, aq->reply->bufsize,
- &aq->reply->len, &reslen, &resgr0);
- parts++;
- } while (status.response_code == 0xFF && resgr0 != 0);
- trace_s390_ap_dqap(AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid),
- status.value, aq->reply->psmid);
- switch (status.response_code) {
- case AP_RESPONSE_NORMAL:
- print_hex_dump_debug("aprpl: ", DUMP_PREFIX_ADDRESS, 16, 1,
- aq->reply->msg, aq->reply->len, false);
- aq->queue_count = max_t(int, 0, aq->queue_count - 1);
- if (!status.queue_empty && !aq->queue_count)
- aq->queue_count++;
- if (aq->queue_count > 0)
- mod_timer(&aq->timeout,
- jiffies + aq->request_timeout);
- list_for_each_entry(ap_msg, &aq->pendingq, list) {
- if (ap_msg->psmid != aq->reply->psmid)
- continue;
- list_del_init(&ap_msg->list);
- aq->pendingq_count--;
- if (parts > 1) {
- ap_msg->rc = -EMSGSIZE;
- ap_msg->receive(aq, ap_msg, NULL);
- } else {
- ap_msg->receive(aq, ap_msg, aq->reply);
- }
- found = true;
- break;
- }
- if (!found) {
- AP_DBF_WARN("%s unassociated reply psmid=0x%016lx on 0x%02x.%04x\n",
- __func__, aq->reply->psmid,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- }
- fallthrough;
- case AP_RESPONSE_NO_PENDING_REPLY:
- if (!status.queue_empty || aq->queue_count <= 0)
- break;
- /* The card shouldn't forget requests but who knows. */
- aq->queue_count = 0;
- list_splice_init(&aq->pendingq, &aq->requestq);
- aq->requestq_count += aq->pendingq_count;
- pr_debug("queue 0x%02x.%04x rescheduled %d reqs (new req %d)\n",
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid),
- aq->pendingq_count, aq->requestq_count);
- aq->pendingq_count = 0;
- break;
- default:
- break;
- }
- return status;
- }
- /**
- * ap_sm_read(): Receive pending reply messages from an AP queue.
- * @aq: pointer to the AP queue
- *
- * Returns AP_SM_WAIT_NONE, AP_SM_WAIT_AGAIN, or AP_SM_WAIT_INTERRUPT
- */
- static enum ap_sm_wait ap_sm_read(struct ap_queue *aq)
- {
- struct ap_queue_status status;
- if (!aq->reply)
- return AP_SM_WAIT_NONE;
- status = ap_sm_recv(aq);
- if (status.async)
- return AP_SM_WAIT_NONE;
- switch (status.response_code) {
- case AP_RESPONSE_NORMAL:
- if (aq->queue_count > 0) {
- aq->sm_state = AP_SM_STATE_WORKING;
- return AP_SM_WAIT_AGAIN;
- }
- aq->sm_state = AP_SM_STATE_IDLE;
- break;
- case AP_RESPONSE_NO_PENDING_REPLY:
- if (aq->queue_count > 0)
- return status.irq_enabled ?
- AP_SM_WAIT_INTERRUPT : AP_SM_WAIT_HIGH_TIMEOUT;
- aq->sm_state = AP_SM_STATE_IDLE;
- break;
- default:
- aq->dev_state = AP_DEV_STATE_ERROR;
- aq->last_err_rc = status.response_code;
- AP_DBF_WARN("%s RC 0x%02x on 0x%02x.%04x -> AP_DEV_STATE_ERROR\n",
- __func__, status.response_code,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- return AP_SM_WAIT_NONE;
- }
- /* Check and maybe enable irq support (again) on this queue */
- if (!status.irq_enabled && status.queue_empty) {
- void *lsi_ptr = ap_airq_ptr();
- if (lsi_ptr && ap_queue_enable_irq(aq, lsi_ptr) == 0) {
- aq->sm_state = AP_SM_STATE_SETIRQ_WAIT;
- return AP_SM_WAIT_AGAIN;
- }
- }
- return AP_SM_WAIT_NONE;
- }
- /**
- * ap_sm_write(): Send messages from the request queue to an AP queue.
- * @aq: pointer to the AP queue
- *
- * Returns AP_SM_WAIT_NONE, AP_SM_WAIT_AGAIN, or AP_SM_WAIT_INTERRUPT
- */
- static enum ap_sm_wait ap_sm_write(struct ap_queue *aq)
- {
- struct ap_queue_status status;
- struct ap_message *ap_msg;
- ap_qid_t qid = aq->qid;
- if (aq->requestq_count <= 0)
- return AP_SM_WAIT_NONE;
- /* Start the next request on the queue. */
- ap_msg = list_entry(aq->requestq.next, struct ap_message, list);
- print_hex_dump_debug("apreq: ", DUMP_PREFIX_ADDRESS, 16, 1,
- ap_msg->msg, ap_msg->len, false);
- status = __ap_send(qid, ap_msg->psmid,
- ap_msg->msg, ap_msg->len,
- ap_msg->flags & AP_MSG_FLAG_SPECIAL);
- if (status.async)
- return AP_SM_WAIT_NONE;
- switch (status.response_code) {
- case AP_RESPONSE_NORMAL:
- aq->queue_count = max_t(int, 1, aq->queue_count + 1);
- if (aq->queue_count == 1)
- mod_timer(&aq->timeout, jiffies + aq->request_timeout);
- list_move_tail(&ap_msg->list, &aq->pendingq);
- aq->requestq_count--;
- aq->pendingq_count++;
- if (aq->queue_count < aq->card->hwinfo.qd + 1) {
- aq->sm_state = AP_SM_STATE_WORKING;
- return AP_SM_WAIT_AGAIN;
- }
- fallthrough;
- case AP_RESPONSE_Q_FULL:
- aq->sm_state = AP_SM_STATE_QUEUE_FULL;
- return status.irq_enabled ?
- AP_SM_WAIT_INTERRUPT : AP_SM_WAIT_HIGH_TIMEOUT;
- case AP_RESPONSE_RESET_IN_PROGRESS:
- aq->sm_state = AP_SM_STATE_RESET_WAIT;
- return AP_SM_WAIT_LOW_TIMEOUT;
- case AP_RESPONSE_INVALID_DOMAIN:
- AP_DBF_WARN("%s RESPONSE_INVALID_DOMAIN on NQAP\n", __func__);
- fallthrough;
- case AP_RESPONSE_MESSAGE_TOO_BIG:
- case AP_RESPONSE_REQ_FAC_NOT_INST:
- list_del_init(&ap_msg->list);
- aq->requestq_count--;
- ap_msg->rc = -EINVAL;
- ap_msg->receive(aq, ap_msg, NULL);
- return AP_SM_WAIT_AGAIN;
- default:
- aq->dev_state = AP_DEV_STATE_ERROR;
- aq->last_err_rc = status.response_code;
- AP_DBF_WARN("%s RC 0x%02x on 0x%02x.%04x -> AP_DEV_STATE_ERROR\n",
- __func__, status.response_code,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- return AP_SM_WAIT_NONE;
- }
- }
- /**
- * ap_sm_read_write(): Send and receive messages to/from an AP queue.
- * @aq: pointer to the AP queue
- *
- * Returns AP_SM_WAIT_NONE, AP_SM_WAIT_AGAIN, or AP_SM_WAIT_INTERRUPT
- */
- static enum ap_sm_wait ap_sm_read_write(struct ap_queue *aq)
- {
- return min(ap_sm_read(aq), ap_sm_write(aq));
- }
- /**
- * ap_sm_reset(): Reset an AP queue.
- * @aq: The AP queue
- *
- * Submit the Reset command to an AP queue.
- */
- static enum ap_sm_wait ap_sm_reset(struct ap_queue *aq)
- {
- struct ap_queue_status status;
- status = ap_rapq(aq->qid, aq->rapq_fbit);
- if (status.async)
- return AP_SM_WAIT_NONE;
- switch (status.response_code) {
- case AP_RESPONSE_NORMAL:
- case AP_RESPONSE_RESET_IN_PROGRESS:
- aq->sm_state = AP_SM_STATE_RESET_WAIT;
- aq->rapq_fbit = 0;
- return AP_SM_WAIT_LOW_TIMEOUT;
- default:
- aq->dev_state = AP_DEV_STATE_ERROR;
- aq->last_err_rc = status.response_code;
- AP_DBF_WARN("%s RC 0x%02x on 0x%02x.%04x -> AP_DEV_STATE_ERROR\n",
- __func__, status.response_code,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- return AP_SM_WAIT_NONE;
- }
- }
- /**
- * ap_sm_reset_wait(): Test queue for completion of the reset operation
- * @aq: pointer to the AP queue
- *
- * Returns AP_POLL_IMMEDIATELY, AP_POLL_AFTER_TIMEROUT or 0.
- */
- static enum ap_sm_wait ap_sm_reset_wait(struct ap_queue *aq)
- {
- struct ap_queue_status status;
- struct ap_tapq_hwinfo hwinfo;
- void *lsi_ptr;
- /* Get the status with TAPQ */
- status = ap_test_queue(aq->qid, 1, &hwinfo);
- switch (status.response_code) {
- case AP_RESPONSE_NORMAL:
- aq->se_bstate = hwinfo.bs;
- lsi_ptr = ap_airq_ptr();
- if (lsi_ptr && ap_queue_enable_irq(aq, lsi_ptr) == 0)
- aq->sm_state = AP_SM_STATE_SETIRQ_WAIT;
- else
- aq->sm_state = (aq->queue_count > 0) ?
- AP_SM_STATE_WORKING : AP_SM_STATE_IDLE;
- return AP_SM_WAIT_AGAIN;
- case AP_RESPONSE_BUSY:
- case AP_RESPONSE_RESET_IN_PROGRESS:
- return AP_SM_WAIT_LOW_TIMEOUT;
- case AP_RESPONSE_Q_NOT_AVAIL:
- case AP_RESPONSE_DECONFIGURED:
- case AP_RESPONSE_CHECKSTOPPED:
- default:
- aq->dev_state = AP_DEV_STATE_ERROR;
- aq->last_err_rc = status.response_code;
- AP_DBF_WARN("%s RC 0x%02x on 0x%02x.%04x -> AP_DEV_STATE_ERROR\n",
- __func__, status.response_code,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- return AP_SM_WAIT_NONE;
- }
- }
- /**
- * ap_sm_setirq_wait(): Test queue for completion of the irq enablement
- * @aq: pointer to the AP queue
- *
- * Returns AP_POLL_IMMEDIATELY, AP_POLL_AFTER_TIMEROUT or 0.
- */
- static enum ap_sm_wait ap_sm_setirq_wait(struct ap_queue *aq)
- {
- struct ap_queue_status status;
- if (aq->queue_count > 0 && aq->reply)
- /* Try to read a completed message and get the status */
- status = ap_sm_recv(aq);
- else
- /* Get the status with TAPQ */
- status = ap_tapq(aq->qid, NULL);
- if (status.irq_enabled == 1) {
- /* Irqs are now enabled */
- aq->sm_state = (aq->queue_count > 0) ?
- AP_SM_STATE_WORKING : AP_SM_STATE_IDLE;
- }
- switch (status.response_code) {
- case AP_RESPONSE_NORMAL:
- if (aq->queue_count > 0)
- return AP_SM_WAIT_AGAIN;
- fallthrough;
- case AP_RESPONSE_NO_PENDING_REPLY:
- return AP_SM_WAIT_LOW_TIMEOUT;
- default:
- aq->dev_state = AP_DEV_STATE_ERROR;
- aq->last_err_rc = status.response_code;
- AP_DBF_WARN("%s RC 0x%02x on 0x%02x.%04x -> AP_DEV_STATE_ERROR\n",
- __func__, status.response_code,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- return AP_SM_WAIT_NONE;
- }
- }
- /**
- * ap_sm_assoc_wait(): Test queue for completion of a pending
- * association request.
- * @aq: pointer to the AP queue
- */
- static enum ap_sm_wait ap_sm_assoc_wait(struct ap_queue *aq)
- {
- struct ap_queue_status status;
- struct ap_tapq_hwinfo hwinfo;
- status = ap_test_queue(aq->qid, 1, &hwinfo);
- /* handle asynchronous error on this queue */
- if (status.async && status.response_code) {
- aq->dev_state = AP_DEV_STATE_ERROR;
- aq->last_err_rc = status.response_code;
- AP_DBF_WARN("%s asynch RC 0x%02x on 0x%02x.%04x -> AP_DEV_STATE_ERROR\n",
- __func__, status.response_code,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- return AP_SM_WAIT_NONE;
- }
- if (status.response_code > AP_RESPONSE_BUSY) {
- aq->dev_state = AP_DEV_STATE_ERROR;
- aq->last_err_rc = status.response_code;
- AP_DBF_WARN("%s RC 0x%02x on 0x%02x.%04x -> AP_DEV_STATE_ERROR\n",
- __func__, status.response_code,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- return AP_SM_WAIT_NONE;
- }
- /* update queue's SE bind state */
- aq->se_bstate = hwinfo.bs;
- /* check bs bits */
- switch (hwinfo.bs) {
- case AP_BS_Q_USABLE:
- /* association is through */
- aq->sm_state = AP_SM_STATE_IDLE;
- pr_debug("queue 0x%02x.%04x associated with %u\n",
- AP_QID_CARD(aq->qid),
- AP_QID_QUEUE(aq->qid), aq->assoc_idx);
- return AP_SM_WAIT_NONE;
- case AP_BS_Q_USABLE_NO_SECURE_KEY:
- /* association still pending */
- return AP_SM_WAIT_LOW_TIMEOUT;
- default:
- /* reset from 'outside' happened or no idea at all */
- aq->assoc_idx = ASSOC_IDX_INVALID;
- aq->dev_state = AP_DEV_STATE_ERROR;
- aq->last_err_rc = status.response_code;
- AP_DBF_WARN("%s bs 0x%02x on 0x%02x.%04x -> AP_DEV_STATE_ERROR\n",
- __func__, hwinfo.bs,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- return AP_SM_WAIT_NONE;
- }
- }
- /*
- * AP state machine jump table
- */
- static ap_func_t *ap_jumptable[NR_AP_SM_STATES][NR_AP_SM_EVENTS] = {
- [AP_SM_STATE_RESET_START] = {
- [AP_SM_EVENT_POLL] = ap_sm_reset,
- [AP_SM_EVENT_TIMEOUT] = ap_sm_nop,
- },
- [AP_SM_STATE_RESET_WAIT] = {
- [AP_SM_EVENT_POLL] = ap_sm_reset_wait,
- [AP_SM_EVENT_TIMEOUT] = ap_sm_nop,
- },
- [AP_SM_STATE_SETIRQ_WAIT] = {
- [AP_SM_EVENT_POLL] = ap_sm_setirq_wait,
- [AP_SM_EVENT_TIMEOUT] = ap_sm_nop,
- },
- [AP_SM_STATE_IDLE] = {
- [AP_SM_EVENT_POLL] = ap_sm_write,
- [AP_SM_EVENT_TIMEOUT] = ap_sm_nop,
- },
- [AP_SM_STATE_WORKING] = {
- [AP_SM_EVENT_POLL] = ap_sm_read_write,
- [AP_SM_EVENT_TIMEOUT] = ap_sm_reset,
- },
- [AP_SM_STATE_QUEUE_FULL] = {
- [AP_SM_EVENT_POLL] = ap_sm_read,
- [AP_SM_EVENT_TIMEOUT] = ap_sm_reset,
- },
- [AP_SM_STATE_ASSOC_WAIT] = {
- [AP_SM_EVENT_POLL] = ap_sm_assoc_wait,
- [AP_SM_EVENT_TIMEOUT] = ap_sm_reset,
- },
- };
- enum ap_sm_wait ap_sm_event(struct ap_queue *aq, enum ap_sm_event event)
- {
- if (aq->config && !aq->chkstop &&
- aq->dev_state > AP_DEV_STATE_UNINITIATED)
- return ap_jumptable[aq->sm_state][event](aq);
- else
- return AP_SM_WAIT_NONE;
- }
- enum ap_sm_wait ap_sm_event_loop(struct ap_queue *aq, enum ap_sm_event event)
- {
- enum ap_sm_wait wait;
- while ((wait = ap_sm_event(aq, event)) == AP_SM_WAIT_AGAIN)
- ;
- return wait;
- }
- /*
- * AP queue related attributes.
- */
- static ssize_t request_count_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct ap_queue *aq = to_ap_queue(dev);
- bool valid = false;
- u64 req_cnt;
- spin_lock_bh(&aq->lock);
- if (aq->dev_state > AP_DEV_STATE_UNINITIATED) {
- req_cnt = aq->total_request_count;
- valid = true;
- }
- spin_unlock_bh(&aq->lock);
- if (valid)
- return sysfs_emit(buf, "%llu\n", req_cnt);
- else
- return sysfs_emit(buf, "-\n");
- }
- static ssize_t request_count_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct ap_queue *aq = to_ap_queue(dev);
- spin_lock_bh(&aq->lock);
- aq->total_request_count = 0;
- spin_unlock_bh(&aq->lock);
- return count;
- }
- static DEVICE_ATTR_RW(request_count);
- static ssize_t requestq_count_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct ap_queue *aq = to_ap_queue(dev);
- unsigned int reqq_cnt = 0;
- spin_lock_bh(&aq->lock);
- if (aq->dev_state > AP_DEV_STATE_UNINITIATED)
- reqq_cnt = aq->requestq_count;
- spin_unlock_bh(&aq->lock);
- return sysfs_emit(buf, "%d\n", reqq_cnt);
- }
- static DEVICE_ATTR_RO(requestq_count);
- static ssize_t pendingq_count_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct ap_queue *aq = to_ap_queue(dev);
- unsigned int penq_cnt = 0;
- spin_lock_bh(&aq->lock);
- if (aq->dev_state > AP_DEV_STATE_UNINITIATED)
- penq_cnt = aq->pendingq_count;
- spin_unlock_bh(&aq->lock);
- return sysfs_emit(buf, "%d\n", penq_cnt);
- }
- static DEVICE_ATTR_RO(pendingq_count);
- static ssize_t reset_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct ap_queue *aq = to_ap_queue(dev);
- int rc = 0;
- spin_lock_bh(&aq->lock);
- switch (aq->sm_state) {
- case AP_SM_STATE_RESET_START:
- case AP_SM_STATE_RESET_WAIT:
- rc = sysfs_emit(buf, "Reset in progress.\n");
- break;
- case AP_SM_STATE_WORKING:
- case AP_SM_STATE_QUEUE_FULL:
- rc = sysfs_emit(buf, "Reset Timer armed.\n");
- break;
- default:
- rc = sysfs_emit(buf, "No Reset Timer set.\n");
- }
- spin_unlock_bh(&aq->lock);
- return rc;
- }
- static ssize_t reset_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct ap_queue *aq = to_ap_queue(dev);
- spin_lock_bh(&aq->lock);
- __ap_flush_queue(aq);
- aq->sm_state = AP_SM_STATE_RESET_START;
- ap_wait(ap_sm_event(aq, AP_SM_EVENT_POLL));
- spin_unlock_bh(&aq->lock);
- AP_DBF_INFO("%s reset queue=%02x.%04x triggered by user\n",
- __func__, AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- return count;
- }
- static DEVICE_ATTR_RW(reset);
- static ssize_t interrupt_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct ap_queue *aq = to_ap_queue(dev);
- struct ap_queue_status status;
- int rc = 0;
- spin_lock_bh(&aq->lock);
- if (aq->sm_state == AP_SM_STATE_SETIRQ_WAIT) {
- rc = sysfs_emit(buf, "Enable Interrupt pending.\n");
- } else {
- status = ap_tapq(aq->qid, NULL);
- if (status.irq_enabled)
- rc = sysfs_emit(buf, "Interrupts enabled.\n");
- else
- rc = sysfs_emit(buf, "Interrupts disabled.\n");
- }
- spin_unlock_bh(&aq->lock);
- return rc;
- }
- static DEVICE_ATTR_RO(interrupt);
- static ssize_t config_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct ap_queue *aq = to_ap_queue(dev);
- int rc;
- spin_lock_bh(&aq->lock);
- rc = sysfs_emit(buf, "%d\n", aq->config ? 1 : 0);
- spin_unlock_bh(&aq->lock);
- return rc;
- }
- static DEVICE_ATTR_RO(config);
- static ssize_t chkstop_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct ap_queue *aq = to_ap_queue(dev);
- int rc;
- spin_lock_bh(&aq->lock);
- rc = sysfs_emit(buf, "%d\n", aq->chkstop ? 1 : 0);
- spin_unlock_bh(&aq->lock);
- return rc;
- }
- static DEVICE_ATTR_RO(chkstop);
- static ssize_t ap_functions_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct ap_queue *aq = to_ap_queue(dev);
- struct ap_queue_status status;
- struct ap_tapq_hwinfo hwinfo;
- status = ap_test_queue(aq->qid, 1, &hwinfo);
- if (status.response_code > AP_RESPONSE_BUSY) {
- pr_debug("RC 0x%02x on tapq(0x%02x.%04x)\n",
- status.response_code,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- return -EIO;
- }
- return sysfs_emit(buf, "0x%08X\n", hwinfo.fac);
- }
- static DEVICE_ATTR_RO(ap_functions);
- static ssize_t driver_override_show(struct device *dev,
- struct device_attribute *attr,
- char *buf)
- {
- struct ap_queue *aq = to_ap_queue(dev);
- struct ap_device *ap_dev = &aq->ap_dev;
- int rc;
- device_lock(dev);
- if (ap_dev->driver_override)
- rc = sysfs_emit(buf, "%s\n", ap_dev->driver_override);
- else
- rc = sysfs_emit(buf, "\n");
- device_unlock(dev);
- return rc;
- }
- static ssize_t driver_override_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct ap_queue *aq = to_ap_queue(dev);
- struct ap_device *ap_dev = &aq->ap_dev;
- int rc = -EINVAL;
- bool old_value;
- if (mutex_lock_interruptible(&ap_attr_mutex))
- return -ERESTARTSYS;
- /* Do not allow driver override if apmask/aqmask is in use */
- if (ap_apmask_aqmask_in_use)
- goto out;
- old_value = ap_dev->driver_override ? true : false;
- rc = driver_set_override(dev, &ap_dev->driver_override, buf, count);
- if (rc)
- goto out;
- if (old_value && !ap_dev->driver_override)
- --ap_driver_override_ctr;
- else if (!old_value && ap_dev->driver_override)
- ++ap_driver_override_ctr;
- rc = count;
- out:
- mutex_unlock(&ap_attr_mutex);
- return rc;
- }
- static DEVICE_ATTR_RW(driver_override);
- #ifdef CONFIG_AP_DEBUG
- static ssize_t states_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct ap_queue *aq = to_ap_queue(dev);
- int rc = 0;
- spin_lock_bh(&aq->lock);
- /* queue device state */
- switch (aq->dev_state) {
- case AP_DEV_STATE_UNINITIATED:
- rc = sysfs_emit(buf, "UNINITIATED\n");
- break;
- case AP_DEV_STATE_OPERATING:
- rc = sysfs_emit(buf, "OPERATING");
- break;
- case AP_DEV_STATE_SHUTDOWN:
- rc = sysfs_emit(buf, "SHUTDOWN");
- break;
- case AP_DEV_STATE_ERROR:
- rc = sysfs_emit(buf, "ERROR");
- break;
- default:
- rc = sysfs_emit(buf, "UNKNOWN");
- }
- /* state machine state */
- if (aq->dev_state) {
- switch (aq->sm_state) {
- case AP_SM_STATE_RESET_START:
- rc += sysfs_emit_at(buf, rc, " [RESET_START]\n");
- break;
- case AP_SM_STATE_RESET_WAIT:
- rc += sysfs_emit_at(buf, rc, " [RESET_WAIT]\n");
- break;
- case AP_SM_STATE_SETIRQ_WAIT:
- rc += sysfs_emit_at(buf, rc, " [SETIRQ_WAIT]\n");
- break;
- case AP_SM_STATE_IDLE:
- rc += sysfs_emit_at(buf, rc, " [IDLE]\n");
- break;
- case AP_SM_STATE_WORKING:
- rc += sysfs_emit_at(buf, rc, " [WORKING]\n");
- break;
- case AP_SM_STATE_QUEUE_FULL:
- rc += sysfs_emit_at(buf, rc, " [FULL]\n");
- break;
- case AP_SM_STATE_ASSOC_WAIT:
- rc += sysfs_emit_at(buf, rc, " [ASSOC_WAIT]\n");
- break;
- default:
- rc += sysfs_emit_at(buf, rc, " [UNKNOWN]\n");
- }
- }
- spin_unlock_bh(&aq->lock);
- return rc;
- }
- static DEVICE_ATTR_RO(states);
- static ssize_t last_err_rc_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct ap_queue *aq = to_ap_queue(dev);
- int rc;
- spin_lock_bh(&aq->lock);
- rc = aq->last_err_rc;
- spin_unlock_bh(&aq->lock);
- switch (rc) {
- case AP_RESPONSE_NORMAL:
- return sysfs_emit(buf, "NORMAL\n");
- case AP_RESPONSE_Q_NOT_AVAIL:
- return sysfs_emit(buf, "Q_NOT_AVAIL\n");
- case AP_RESPONSE_RESET_IN_PROGRESS:
- return sysfs_emit(buf, "RESET_IN_PROGRESS\n");
- case AP_RESPONSE_DECONFIGURED:
- return sysfs_emit(buf, "DECONFIGURED\n");
- case AP_RESPONSE_CHECKSTOPPED:
- return sysfs_emit(buf, "CHECKSTOPPED\n");
- case AP_RESPONSE_BUSY:
- return sysfs_emit(buf, "BUSY\n");
- case AP_RESPONSE_INVALID_ADDRESS:
- return sysfs_emit(buf, "INVALID_ADDRESS\n");
- case AP_RESPONSE_OTHERWISE_CHANGED:
- return sysfs_emit(buf, "OTHERWISE_CHANGED\n");
- case AP_RESPONSE_Q_FULL:
- return sysfs_emit(buf, "Q_FULL/NO_PENDING_REPLY\n");
- case AP_RESPONSE_INDEX_TOO_BIG:
- return sysfs_emit(buf, "INDEX_TOO_BIG\n");
- case AP_RESPONSE_NO_FIRST_PART:
- return sysfs_emit(buf, "NO_FIRST_PART\n");
- case AP_RESPONSE_MESSAGE_TOO_BIG:
- return sysfs_emit(buf, "MESSAGE_TOO_BIG\n");
- case AP_RESPONSE_REQ_FAC_NOT_INST:
- return sysfs_emit(buf, "REQ_FAC_NOT_INST\n");
- default:
- return sysfs_emit(buf, "response code %d\n", rc);
- }
- }
- static DEVICE_ATTR_RO(last_err_rc);
- #endif
- static struct attribute *ap_queue_dev_attrs[] = {
- &dev_attr_request_count.attr,
- &dev_attr_requestq_count.attr,
- &dev_attr_pendingq_count.attr,
- &dev_attr_reset.attr,
- &dev_attr_interrupt.attr,
- &dev_attr_config.attr,
- &dev_attr_chkstop.attr,
- &dev_attr_ap_functions.attr,
- &dev_attr_driver_override.attr,
- #ifdef CONFIG_AP_DEBUG
- &dev_attr_states.attr,
- &dev_attr_last_err_rc.attr,
- #endif
- NULL
- };
- static struct attribute_group ap_queue_dev_attr_group = {
- .attrs = ap_queue_dev_attrs
- };
- static const struct attribute_group *ap_queue_dev_attr_groups[] = {
- &ap_queue_dev_attr_group,
- NULL
- };
- static struct device_type ap_queue_type = {
- .name = "ap_queue",
- .groups = ap_queue_dev_attr_groups,
- };
- static ssize_t se_bind_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct ap_queue *aq = to_ap_queue(dev);
- struct ap_queue_status status;
- struct ap_tapq_hwinfo hwinfo;
- if (!ap_q_supports_bind(aq))
- return sysfs_emit(buf, "-\n");
- status = ap_test_queue(aq->qid, 1, &hwinfo);
- if (status.response_code > AP_RESPONSE_BUSY) {
- pr_debug("RC 0x%02x on tapq(0x%02x.%04x)\n",
- status.response_code,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- return -EIO;
- }
- /* update queue's SE bind state */
- spin_lock_bh(&aq->lock);
- aq->se_bstate = hwinfo.bs;
- spin_unlock_bh(&aq->lock);
- switch (hwinfo.bs) {
- case AP_BS_Q_USABLE:
- case AP_BS_Q_USABLE_NO_SECURE_KEY:
- return sysfs_emit(buf, "bound\n");
- default:
- return sysfs_emit(buf, "unbound\n");
- }
- }
- static ssize_t se_bind_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct ap_queue *aq = to_ap_queue(dev);
- struct ap_queue_status status;
- struct ap_tapq_hwinfo hwinfo;
- bool value;
- int rc;
- if (!ap_q_supports_bind(aq))
- return -EINVAL;
- /* only 0 (unbind) and 1 (bind) allowed */
- rc = kstrtobool(buf, &value);
- if (rc)
- return rc;
- if (!value) {
- /* Unbind. Set F bit arg and trigger RAPQ */
- spin_lock_bh(&aq->lock);
- __ap_flush_queue(aq);
- aq->rapq_fbit = 1;
- _ap_queue_init_state(aq);
- rc = count;
- goto out;
- }
- /* Bind. Check current SE bind state */
- status = ap_test_queue(aq->qid, 1, &hwinfo);
- if (status.response_code) {
- AP_DBF_WARN("%s RC 0x%02x on tapq(0x%02x.%04x)\n",
- __func__, status.response_code,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- return -EIO;
- }
- /* Update BS state */
- spin_lock_bh(&aq->lock);
- aq->se_bstate = hwinfo.bs;
- if (hwinfo.bs != AP_BS_Q_AVAIL_FOR_BINDING) {
- AP_DBF_WARN("%s bind attempt with bs %d on queue 0x%02x.%04x\n",
- __func__, hwinfo.bs,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- rc = -EINVAL;
- goto out;
- }
- /* Check SM state */
- if (aq->sm_state < AP_SM_STATE_IDLE) {
- rc = -EBUSY;
- goto out;
- }
- /* invoke BAPQ */
- status = ap_bapq(aq->qid);
- if (status.response_code) {
- AP_DBF_WARN("%s RC 0x%02x on bapq(0x%02x.%04x)\n",
- __func__, status.response_code,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- rc = -EIO;
- goto out;
- }
- aq->assoc_idx = ASSOC_IDX_INVALID;
- /* verify SE bind state */
- status = ap_test_queue(aq->qid, 1, &hwinfo);
- if (status.response_code) {
- AP_DBF_WARN("%s RC 0x%02x on tapq(0x%02x.%04x)\n",
- __func__, status.response_code,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- rc = -EIO;
- goto out;
- }
- aq->se_bstate = hwinfo.bs;
- if (!(hwinfo.bs == AP_BS_Q_USABLE ||
- hwinfo.bs == AP_BS_Q_USABLE_NO_SECURE_KEY)) {
- AP_DBF_WARN("%s BAPQ success, but bs shows %d on queue 0x%02x.%04x\n",
- __func__, hwinfo.bs,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- rc = -EIO;
- goto out;
- }
- /* SE bind was successful */
- AP_DBF_INFO("%s bapq(0x%02x.%04x) success\n", __func__,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- rc = count;
- out:
- spin_unlock_bh(&aq->lock);
- return rc;
- }
- static DEVICE_ATTR_RW(se_bind);
- static ssize_t se_associate_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct ap_queue *aq = to_ap_queue(dev);
- struct ap_queue_status status;
- struct ap_tapq_hwinfo hwinfo;
- if (!ap_q_supports_assoc(aq))
- return sysfs_emit(buf, "-\n");
- status = ap_test_queue(aq->qid, 1, &hwinfo);
- if (status.response_code > AP_RESPONSE_BUSY) {
- pr_debug("RC 0x%02x on tapq(0x%02x.%04x)\n",
- status.response_code,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- return -EIO;
- }
- /* update queue's SE bind state */
- spin_lock_bh(&aq->lock);
- aq->se_bstate = hwinfo.bs;
- spin_unlock_bh(&aq->lock);
- switch (hwinfo.bs) {
- case AP_BS_Q_USABLE:
- if (aq->assoc_idx == ASSOC_IDX_INVALID) {
- AP_DBF_WARN("%s AP_BS_Q_USABLE but invalid assoc_idx\n", __func__);
- return -EIO;
- }
- return sysfs_emit(buf, "associated %u\n", aq->assoc_idx);
- case AP_BS_Q_USABLE_NO_SECURE_KEY:
- if (aq->assoc_idx != ASSOC_IDX_INVALID)
- return sysfs_emit(buf, "association pending\n");
- fallthrough;
- default:
- return sysfs_emit(buf, "unassociated\n");
- }
- }
- static ssize_t se_associate_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct ap_queue *aq = to_ap_queue(dev);
- struct ap_queue_status status;
- struct ap_tapq_hwinfo hwinfo;
- unsigned int value;
- int rc;
- if (!ap_q_supports_assoc(aq))
- return -EINVAL;
- /* association index needs to be >= 0 */
- rc = kstrtouint(buf, 0, &value);
- if (rc)
- return rc;
- if (value >= ASSOC_IDX_INVALID)
- return -EINVAL;
- /* check current SE bind state */
- status = ap_test_queue(aq->qid, 1, &hwinfo);
- if (status.response_code) {
- AP_DBF_WARN("%s RC 0x%02x on tapq(0x%02x.%04x)\n",
- __func__, status.response_code,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- return -EIO;
- }
- spin_lock_bh(&aq->lock);
- aq->se_bstate = hwinfo.bs;
- if (hwinfo.bs != AP_BS_Q_USABLE_NO_SECURE_KEY) {
- AP_DBF_WARN("%s association attempt with bs %d on queue 0x%02x.%04x\n",
- __func__, hwinfo.bs,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- rc = -EINVAL;
- goto out;
- }
- /* check SM state */
- if (aq->sm_state != AP_SM_STATE_IDLE) {
- rc = -EBUSY;
- goto out;
- }
- /* trigger the asynchronous association request */
- status = ap_aapq(aq->qid, value);
- switch (status.response_code) {
- case AP_RESPONSE_NORMAL:
- case AP_RESPONSE_STATE_CHANGE_IN_PROGRESS:
- aq->sm_state = AP_SM_STATE_ASSOC_WAIT;
- aq->assoc_idx = value;
- ap_wait(ap_sm_event(aq, AP_SM_EVENT_POLL));
- break;
- default:
- AP_DBF_WARN("%s RC 0x%02x on aapq(0x%02x.%04x)\n",
- __func__, status.response_code,
- AP_QID_CARD(aq->qid), AP_QID_QUEUE(aq->qid));
- rc = -EIO;
- goto out;
- }
- rc = count;
- out:
- spin_unlock_bh(&aq->lock);
- return rc;
- }
- static DEVICE_ATTR_RW(se_associate);
- static struct attribute *ap_queue_dev_sb_attrs[] = {
- &dev_attr_se_bind.attr,
- &dev_attr_se_associate.attr,
- NULL
- };
- static struct attribute_group ap_queue_dev_sb_attr_group = {
- .attrs = ap_queue_dev_sb_attrs
- };
- static const struct attribute_group *ap_queue_dev_sb_attr_groups[] = {
- &ap_queue_dev_sb_attr_group,
- NULL
- };
- static void ap_queue_device_release(struct device *dev)
- {
- struct ap_queue *aq = to_ap_queue(dev);
- spin_lock_bh(&ap_queues_lock);
- hash_del(&aq->hnode);
- spin_unlock_bh(&ap_queues_lock);
- kfree(aq);
- }
- struct ap_queue *ap_queue_create(ap_qid_t qid, struct ap_card *ac)
- {
- struct ap_queue *aq;
- aq = kzalloc_obj(*aq);
- if (!aq)
- return NULL;
- aq->card = ac;
- aq->ap_dev.device.release = ap_queue_device_release;
- aq->ap_dev.device.type = &ap_queue_type;
- aq->ap_dev.device_type = ac->ap_dev.device_type;
- /* in SE environment add bind/associate attributes group */
- if (ap_is_se_guest() && ap_q_supported_in_se(aq))
- aq->ap_dev.device.groups = ap_queue_dev_sb_attr_groups;
- aq->qid = qid;
- spin_lock_init(&aq->lock);
- INIT_LIST_HEAD(&aq->pendingq);
- INIT_LIST_HEAD(&aq->requestq);
- timer_setup(&aq->timeout, ap_request_timeout, 0);
- return aq;
- }
- void ap_queue_init_reply(struct ap_queue *aq, struct ap_message *reply)
- {
- aq->reply = reply;
- spin_lock_bh(&aq->lock);
- ap_wait(ap_sm_event(aq, AP_SM_EVENT_POLL));
- spin_unlock_bh(&aq->lock);
- }
- EXPORT_SYMBOL(ap_queue_init_reply);
- /**
- * ap_queue_message(): Queue a request to an AP device.
- * @aq: The AP device to queue the message to
- * @ap_msg: The message that is to be added
- */
- int ap_queue_message(struct ap_queue *aq, struct ap_message *ap_msg)
- {
- int rc = 0;
- /* msg needs to have a valid receive-callback */
- BUG_ON(!ap_msg->receive);
- spin_lock_bh(&aq->lock);
- /* only allow to queue new messages if device state is ok */
- if (aq->dev_state == AP_DEV_STATE_OPERATING) {
- list_add_tail(&ap_msg->list, &aq->requestq);
- aq->requestq_count++;
- aq->total_request_count++;
- atomic64_inc(&aq->card->total_request_count);
- } else {
- rc = -ENODEV;
- }
- /* Send/receive as many request from the queue as possible. */
- ap_wait(ap_sm_event_loop(aq, AP_SM_EVENT_POLL));
- spin_unlock_bh(&aq->lock);
- return rc;
- }
- EXPORT_SYMBOL(ap_queue_message);
- /**
- * ap_queue_usable(): Check if queue is usable just now.
- * @aq: The AP queue device to test for usability.
- * This function is intended for the scheduler to query if it makes
- * sense to enqueue a message into this AP queue device by calling
- * ap_queue_message(). The perspective is very short-term as the
- * state machine and device state(s) may change at any time.
- */
- bool ap_queue_usable(struct ap_queue *aq)
- {
- bool rc = true;
- spin_lock_bh(&aq->lock);
- /* check for not configured or checkstopped */
- if (!aq->config || aq->chkstop) {
- rc = false;
- goto unlock_and_out;
- }
- /* device state needs to be ok */
- if (aq->dev_state != AP_DEV_STATE_OPERATING) {
- rc = false;
- goto unlock_and_out;
- }
- /* SE guest's queues additionally need to be bound */
- if (ap_is_se_guest()) {
- if (!ap_q_supported_in_se(aq)) {
- rc = false;
- goto unlock_and_out;
- }
- if (ap_q_needs_bind(aq) &&
- !(aq->se_bstate == AP_BS_Q_USABLE ||
- aq->se_bstate == AP_BS_Q_USABLE_NO_SECURE_KEY))
- rc = false;
- }
- unlock_and_out:
- spin_unlock_bh(&aq->lock);
- return rc;
- }
- EXPORT_SYMBOL(ap_queue_usable);
- /**
- * ap_cancel_message(): Cancel a crypto request.
- * @aq: The AP device that has the message queued
- * @ap_msg: The message that is to be removed
- *
- * Cancel a crypto request. This is done by removing the request
- * from the device pending or request queue. Note that the
- * request stays on the AP queue. When it finishes the message
- * reply will be discarded because the psmid can't be found.
- */
- void ap_cancel_message(struct ap_queue *aq, struct ap_message *ap_msg)
- {
- struct ap_message *tmp;
- spin_lock_bh(&aq->lock);
- if (!list_empty(&ap_msg->list)) {
- list_for_each_entry(tmp, &aq->pendingq, list)
- if (tmp->psmid == ap_msg->psmid) {
- aq->pendingq_count--;
- goto found;
- }
- aq->requestq_count--;
- found:
- list_del_init(&ap_msg->list);
- }
- spin_unlock_bh(&aq->lock);
- }
- EXPORT_SYMBOL(ap_cancel_message);
- /**
- * __ap_flush_queue(): Flush requests.
- * @aq: Pointer to the AP queue
- *
- * Flush all requests from the request/pending queue of an AP device.
- */
- static void __ap_flush_queue(struct ap_queue *aq)
- {
- struct ap_message *ap_msg, *next;
- list_for_each_entry_safe(ap_msg, next, &aq->pendingq, list) {
- list_del_init(&ap_msg->list);
- aq->pendingq_count--;
- ap_msg->rc = -EAGAIN;
- ap_msg->receive(aq, ap_msg, NULL);
- }
- list_for_each_entry_safe(ap_msg, next, &aq->requestq, list) {
- list_del_init(&ap_msg->list);
- aq->requestq_count--;
- ap_msg->rc = -EAGAIN;
- ap_msg->receive(aq, ap_msg, NULL);
- }
- aq->queue_count = 0;
- }
- void ap_flush_queue(struct ap_queue *aq)
- {
- spin_lock_bh(&aq->lock);
- __ap_flush_queue(aq);
- spin_unlock_bh(&aq->lock);
- }
- EXPORT_SYMBOL(ap_flush_queue);
- void ap_queue_prepare_remove(struct ap_queue *aq)
- {
- spin_lock_bh(&aq->lock);
- /* flush queue */
- __ap_flush_queue(aq);
- /* move queue device state to SHUTDOWN in progress */
- aq->dev_state = AP_DEV_STATE_SHUTDOWN;
- spin_unlock_bh(&aq->lock);
- timer_delete_sync(&aq->timeout);
- }
- void ap_queue_remove(struct ap_queue *aq)
- {
- /*
- * all messages have been flushed and the device state
- * is SHUTDOWN. Now reset with zero which also clears
- * the irq registration and move the device state
- * to the initial value AP_DEV_STATE_UNINITIATED.
- */
- spin_lock_bh(&aq->lock);
- ap_zapq(aq->qid, 0);
- aq->dev_state = AP_DEV_STATE_UNINITIATED;
- spin_unlock_bh(&aq->lock);
- }
- void _ap_queue_init_state(struct ap_queue *aq)
- {
- aq->dev_state = AP_DEV_STATE_OPERATING;
- aq->sm_state = AP_SM_STATE_RESET_START;
- aq->last_err_rc = 0;
- aq->assoc_idx = ASSOC_IDX_INVALID;
- ap_wait(ap_sm_event(aq, AP_SM_EVENT_POLL));
- }
- void ap_queue_init_state(struct ap_queue *aq)
- {
- spin_lock_bh(&aq->lock);
- _ap_queue_init_state(aq);
- spin_unlock_bh(&aq->lock);
- }
- EXPORT_SYMBOL(ap_queue_init_state);
|