#include #include #include #include #include #include #include #include #include #include #include static void proc_mail_free_saved_buffer(void* udata) { free(udata); } void proc_cleanup_resource_mail(struct proc_resource* resource, struct reschedule_ctx* rctx) { struct proc_mail* mail = &resource->u.mail; while (mail->send_sq.proc_list != NULL) { struct list_node_link* node = mail->send_sq.proc_list; struct proc_sq_entry* sq_entry = list_entry(node, struct proc_sq_entry, sq_link); struct proc* suspended_proc = sq_entry->proc; proc_sq_resume(suspended_proc, sq_entry, rctx, 0); } } void proc_mail_send(struct proc* proc, struct proc_mail* mail, struct reschedule_ctx* rctx, void* data, size_t data_size) { /* mail full */ if (mail->packets_count == PROC_MAIL_MAX) { struct mail_saved_buffer* saved_buffer = malloc(sizeof(*saved_buffer)); saved_buffer->buffer = data; saved_buffer->size = data_size; proc_sq_suspend(proc, &mail->send_sq, rctx, saved_buffer, &proc_mail_free_saved_buffer); return; } /* if receiver available, hand off directly */ struct list_node_link* node = mail->recv_sq.proc_list; if (node != NULL) { struct proc_sq_entry* sq_entry = list_entry(node, struct proc_sq_entry, sq_link); struct proc* resumed_proc = sq_entry->proc; struct mail_saved_buffer* saved_buffer = sq_entry->udata; size_t copy_size = min(data_size, saved_buffer->size); memcpy(saved_buffer->buffer, data, copy_size); proc_sq_resume(resumed_proc, sq_entry, rctx, copy_size); return; } /* mail is empty and nobody is waiting */ void* mesg = malloc(data_size); if (mesg != NULL) { memcpy(mesg, data, data_size); struct mail_packet* packet = malloc(sizeof(*packet)); if (packet == NULL) { free(mesg); } else { memset(packet, 0, sizeof(*packet)); packet->packet_buffer = mesg; packet->packet_size = data_size; list_append(mail->packets, &packet->packets_link); mail->packets_count++; } } } void proc_mail_receive(struct proc* proc, struct proc_mail* mail, struct reschedule_ctx* rctx, void* recv_buffer, size_t recv_size) { /* consume mesg if available */ if (mail->packets_count > 0) { struct mail_packet* packet = list_entry(mail->packets, struct mail_packet, packets_link); list_remove(mail->packets, &packet->packets_link); mail->packets_count--; size_t copy_size = min(recv_size, packet->packet_size); memcpy(recv_buffer, packet->packet_buffer, copy_size); free(packet->packet_buffer); free(packet); struct list_node_link* node = mail->send_sq.proc_list; if (node != NULL) { struct proc_sq_entry* sq_entry = list_entry(node, struct proc_sq_entry, sq_link); struct proc* resumed_proc = sq_entry->proc; proc_sq_resume(resumed_proc, sq_entry, rctx, copy_size); return; } return; } struct mail_saved_buffer* saved_buffer = malloc(sizeof(*saved_buffer)); saved_buffer->buffer = recv_buffer; saved_buffer->size = recv_size; /* nothing to receive */ proc_sq_suspend(proc, &mail->recv_sq, rctx, saved_buffer, &proc_mail_free_saved_buffer); }