Context Navigation

source: mainline/uspace/srv/bd/vbd/disk.c@ f57ccb5

Visit:

lfn serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export

Last change on this file since f57ccb5 was f57ccb5, checked in by Jiri Svoboda <jiri@…>, 10 years ago
Set partition type based on selected filesystem type.
Property mode set to `100644`
File size: 18.4 KB

Rev	Line
[28ed0d9]	1	/*
	2	* Copyright (c) 2015 Jiri Svoboda
	3	* All rights reserved.
	4	*
	5	* Redistribution and use in source and binary forms, with or without
	6	* modification, are permitted provided that the following conditions
	7	* are met:
	8	*
	9	* - Redistributions of source code must retain the above copyright
	10	* notice, this list of conditions and the following disclaimer.
	11	* - Redistributions in binary form must reproduce the above copyright
	12	* notice, this list of conditions and the following disclaimer in the
	13	* documentation and/or other materials provided with the distribution.
	14	* - The name of the author may not be used to endorse or promote products
	15	* derived from this software without specific prior written permission.
	16	*
	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
	27	*/
	28
	29	/** @addtogroup vbd
	30	* @{
	31	*/
	32	/**
	33	* @file
	34	*/
	35
	36	#include <adt/list.h>
[78d50bd]	37	#include <bd_srv.h>
	38	#include <block.h>
[28ed0d9]	39	#include <errno.h>
	40	#include <io/log.h>
[78d50bd]	41	#include <loc.h>
	42	#include <stdio.h>
[28ed0d9]	43	#include <stdlib.h>
	44	#include <task.h>
[6a0d4ce2]	45	#include <vbd.h>
[28ed0d9]	46
	47	#include "disk.h"
	48	#include "types/vbd.h"
	49
	50	static list_t vbds_disks; /* of vbds_disk_t */
[78d50bd]	51	static list_t vbds_parts; /* of vbds_part_t */
	52
	53	static int vbds_bd_open(bd_srvs_t , bd_srv_t );
	54	static int vbds_bd_close(bd_srv_t *);
	55	static int vbds_bd_read_blocks(bd_srv_t , aoff64_t, size_t, void , size_t);
	56	static int vbds_bd_sync_cache(bd_srv_t *, aoff64_t, size_t);
	57	static int vbds_bd_write_blocks(bd_srv_t , aoff64_t, size_t, const void ,
	58	size_t);
	59	static int vbds_bd_get_block_size(bd_srv_t , size_t );
	60	static int vbds_bd_get_num_blocks(bd_srv_t , aoff64_t );
	61
	62	static int vbds_bsa_translate(vbds_part_t , aoff64_t, size_t, aoff64_t );
	63
[6439741]	64	static int vbds_part_svc_register(vbds_part_t *);
	65	static int vbds_part_svc_unregister(vbds_part_t *);
	66	static int vbds_part_indices_update(vbds_disk_t *);
	67
[c43db5f]	68	static vbd_part_id_t vbds_part_id = 1;
	69
[78d50bd]	70	static bd_ops_t vbds_bd_ops = {
	71	.open = vbds_bd_open,
	72	.close = vbds_bd_close,
	73	.read_blocks = vbds_bd_read_blocks,
	74	.sync_cache = vbds_bd_sync_cache,
	75	.write_blocks = vbds_bd_write_blocks,
	76	.get_block_size = vbds_bd_get_block_size,
	77	.get_num_blocks = vbds_bd_get_num_blocks
	78	};
	79
	80	static vbds_part_t bd_srv_part(bd_srv_t bd)
	81	{
	82	return (vbds_part_t *)bd->srvs->sarg;
	83	}
[28ed0d9]	84
	85	void vbds_disks_init(void)
	86	{
	87	list_initialize(&vbds_disks);
[78d50bd]	88	list_initialize(&vbds_parts);
[28ed0d9]	89	}
	90
	91	static int vbds_disk_by_svcid(service_id_t sid, vbds_disk_t **rdisk)
	92	{
	93	list_foreach(vbds_disks, ldisks, vbds_disk_t, disk) {
	94	if (disk->svc_id == sid) {
	95	*rdisk = disk;
	96	return EOK;
	97	}
	98	}
	99
	100	return ENOENT;
	101	}
	102
[c43db5f]	103	static int vbds_part_by_pid(vbds_part_id_t partid, vbds_part_t **rpart)
	104	{
	105	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_part_by_pid(%zu)", partid);
	106
	107	list_foreach(vbds_parts, lparts, vbds_part_t, part) {
	108	log_msg(LOG_DEFAULT, LVL_NOTE, "%zu == %zu ?", part->pid, partid);
	109	if (part->pid == partid) {
	110	log_msg(LOG_DEFAULT, LVL_NOTE, "Found match.");
	111	*rpart = part;
	112	return EOK;
	113	}
	114	}
	115
	116	log_msg(LOG_DEFAULT, LVL_NOTE, "No match.");
	117	return ENOENT;
	118	}
	119
	120	static int vbds_part_by_svcid(service_id_t svcid, vbds_part_t **rpart)
[78d50bd]	121	{
[c43db5f]	122	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_part_by_svcid(%zu)", svcid);
[3faa03d]	123
[78d50bd]	124	list_foreach(vbds_parts, lparts, vbds_part_t, part) {
[c43db5f]	125	log_msg(LOG_DEFAULT, LVL_NOTE, "%zu == %zu ?", part->svc_id, svcid);
	126	if (part->svc_id == svcid) {
[3faa03d]	127	log_msg(LOG_DEFAULT, LVL_NOTE, "Found match.");
[78d50bd]	128	*rpart = part;
	129	return EOK;
	130	}
	131	}
	132
[3faa03d]	133	log_msg(LOG_DEFAULT, LVL_NOTE, "No match.");
[78d50bd]	134	return ENOENT;
	135	}
	136
[99c23405]	137	/** Add partition to our inventory based on liblabel partition structure */
[6bc542b]	138	static int vbds_part_add(vbds_disk_t disk, label_part_t lpart,
	139	vbds_part_t **rpart)
[28ed0d9]	140	{
	141	vbds_part_t *part;
[c43db5f]	142	service_id_t psid = 0;
[78d50bd]	143	label_part_info_t lpinfo;
	144	int rc;
[28ed0d9]	145
[78d50bd]	146	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_part_add(%s, %p)",
	147	disk->svc_name, lpart);
[28ed0d9]	148
[b7a4d06]	149	label_part_get_info(lpart, &lpinfo);
	150
[28ed0d9]	151	part = calloc(1, sizeof(vbds_part_t));
	152	if (part == NULL) {
	153	log_msg(LOG_DEFAULT, LVL_ERROR, "Out of memory.");
	154	return ENOMEM;
	155	}
	156
	157	part->lpart = lpart;
	158	part->disk = disk;
[c43db5f]	159	part->pid = ++vbds_part_id;
	160	part->svc_id = psid;
[78d50bd]	161	part->block0 = lpinfo.block0;
	162	part->nblocks = lpinfo.nblocks;
	163
	164	bd_srvs_init(&part->bds);
	165	part->bds.ops = &vbds_bd_ops;
	166	part->bds.sarg = part;
	167
[6439741]	168	if (lpinfo.pkind != lpk_extended) {
	169	rc = vbds_part_svc_register(part);
	170	if (rc != EOK)
	171	return EIO;
	172	}
	173
[28ed0d9]	174	list_append(&part->ldisk, &disk->parts);
[78d50bd]	175	list_append(&part->lparts, &vbds_parts);
[28ed0d9]	176
[6bc542b]	177	if (rpart != NULL)
	178	*rpart = part;
[28ed0d9]	179	return EOK;
	180	}
	181
[99c23405]	182	/** Remove partition from our inventory leaving only the underlying liblabel
	183	* partition structure.
	184	*/
	185	static int vbds_part_remove(vbds_part_t part, label_part_t *rlpart)
	186	{
	187	label_part_t *lpart;
	188	int rc;
	189
	190	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_part_remove(%p)", part);
	191
	192	lpart = part->lpart;
	193
	194	if (part->open_cnt > 0)
	195	return EBUSY;
	196
[c43db5f]	197	if (part->svc_id != 0) {
[6439741]	198	rc = vbds_part_svc_unregister(part);
[c43db5f]	199	if (rc != EOK)
	200	return EIO;
	201	}
[99c23405]	202
	203	list_remove(&part->ldisk);
	204	list_remove(&part->lparts);
	205	free(part);
	206
	207	if (rlpart != NULL)
	208	*rlpart = lpart;
	209	return EOK;
	210	}
	211
[28ed0d9]	212	int vbds_disk_add(service_id_t sid)
	213	{
[3faa03d]	214	label_t *label = NULL;
[28ed0d9]	215	label_part_t *part;
[78d50bd]	216	vbds_disk_t *disk = NULL;
	217	bool block_inited = false;
	218	size_t block_size;
[28ed0d9]	219	int rc;
	220
	221	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_disk_add(%zu)", sid);
	222
	223	/* Check for duplicates */
	224	rc = vbds_disk_by_svcid(sid, &disk);
	225	if (rc == EOK)
	226	return EEXISTS;
	227
	228	disk = calloc(1, sizeof(vbds_disk_t));
	229	if (disk == NULL)
	230	return ENOMEM;
	231
[78d50bd]	232	rc = loc_service_get_name(sid, &disk->svc_name);
	233	if (rc != EOK) {
	234	log_msg(LOG_DEFAULT, LVL_ERROR, "Failed getting disk service name.");
	235	rc = EIO;
	236	goto error;
	237	}
	238
[603c1d1f]	239	log_msg(LOG_DEFAULT, LVL_NOTE, "block_init(%zu)", sid);
[78d50bd]	240	rc = block_init(EXCHANGE_SERIALIZE, sid, 2048);
	241	if (rc != EOK) {
	242	log_msg(LOG_DEFAULT, LVL_ERROR, "Failed opening block device %s.",
	243	disk->svc_name);
	244	rc = EIO;
	245	goto error;
	246	}
	247
	248	rc = block_get_bsize(sid, &block_size);
	249	if (rc != EOK) {
	250	log_msg(LOG_DEFAULT, LVL_ERROR, "Failed getting block size of %s.",
	251	disk->svc_name);
	252	rc = EIO;
	253	goto error;
	254	}
	255
	256	block_inited = true;
	257
[28ed0d9]	258	rc = label_open(sid, &label);
[78d50bd]	259	if (rc != EOK) {
[3faa03d]	260	log_msg(LOG_DEFAULT, LVL_NOTE, "Label in disk %s not recognized.",
	261	disk->svc_name);
[78d50bd]	262	rc = EIO;
[28ed0d9]	263	goto error;
[78d50bd]	264	}
[28ed0d9]	265
	266	disk->svc_id = sid;
	267	disk->label = label;
[78d50bd]	268	disk->block_size = block_size;
	269
[28ed0d9]	270	list_initialize(&disk->parts);
	271	list_append(&disk->ldisks, &vbds_disks);
	272
[3faa03d]	273	log_msg(LOG_DEFAULT, LVL_NOTE, "Recognized disk label. Adding partitions.");
	274
[28ed0d9]	275	part = label_part_first(label);
	276	while (part != NULL) {
[6bc542b]	277	rc = vbds_part_add(disk, part, NULL);
[28ed0d9]	278	if (rc != EOK) {
[78d50bd]	279	log_msg(LOG_DEFAULT, LVL_ERROR, "Failed adding partitio "
	280	"(disk %s)", disk->svc_name);
[28ed0d9]	281	}
	282
	283	part = label_part_next(part);
	284	}
	285
	286	return EOK;
	287	error:
[78d50bd]	288	label_close(label);
[603c1d1f]	289	if (block_inited) {
	290	log_msg(LOG_DEFAULT, LVL_NOTE, "block_fini(%zu)", sid);
[78d50bd]	291	block_fini(sid);
[603c1d1f]	292	}
[78d50bd]	293	if (disk != NULL)
	294	free(disk->svc_name);
[28ed0d9]	295	free(disk);
	296	return rc;
	297	}
	298
	299	int vbds_disk_remove(service_id_t sid)
	300	{
	301	vbds_disk_t *disk;
	302	int rc;
	303
	304	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_disk_remove(%zu)", sid);
	305
	306	rc = vbds_disk_by_svcid(sid, &disk);
	307	if (rc != EOK)
	308	return rc;
	309
	310	list_remove(&disk->ldisks);
	311	label_close(disk->label);
[603c1d1f]	312	log_msg(LOG_DEFAULT, LVL_NOTE, "block_fini(%zu)", sid);
	313	block_fini(sid);
[28ed0d9]	314	free(disk);
	315	return EOK;
	316	}
	317
[b7a4d06]	318	int vbds_disk_info(service_id_t sid, vbd_disk_info_t *info)
[28ed0d9]	319	{
[1626cd4]	320	vbds_disk_t *disk;
	321	label_info_t linfo;
	322	int rc;
	323
[28ed0d9]	324	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_disk_info(%zu)", sid);
[1626cd4]	325
	326	rc = vbds_disk_by_svcid(sid, &disk);
	327	if (rc != EOK)
	328	return rc;
	329
	330	rc = label_get_info(disk->label, &linfo);
	331
	332	info->ltype = linfo.ltype;
[b7a4d06]	333	info->flags = linfo.flags;
[1626cd4]	334	info->ablock0 = linfo.ablock0;
	335	info->anblocks = linfo.anblocks;
	336	info->block_size = disk->block_size;
[c02d098]	337	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_disk_info - block_size=%zu",
	338	info->block_size);
[1626cd4]	339	return EOK;
	340	}
	341
	342	int vbds_get_parts(service_id_t sid, service_id_t *id_buf, size_t buf_size,
	343	size_t *act_size)
	344	{
	345	vbds_disk_t *disk;
	346	size_t act_cnt;
	347	size_t buf_cnt;
	348	int rc;
	349
	350	rc = vbds_disk_by_svcid(sid, &disk);
	351	if (rc != EOK)
	352	return rc;
	353
	354	buf_cnt = buf_size / sizeof(service_id_t);
	355
	356	act_cnt = list_count(&disk->parts);
	357	act_size = act_cnt sizeof(service_id_t);
	358
	359	if (buf_size % sizeof(service_id_t) != 0)
	360	return EINVAL;
	361
	362	size_t pos = 0;
	363	list_foreach(disk->parts, ldisk, vbds_part_t, part) {
	364	if (pos < buf_cnt)
[c43db5f]	365	id_buf[pos] = part->pid;
[1626cd4]	366	pos++;
	367	}
	368
[28ed0d9]	369	return EOK;
	370	}
	371
[1626cd4]	372
[28ed0d9]	373	int vbds_label_create(service_id_t sid, label_type_t ltype)
	374	{
	375	label_t *label;
	376	vbds_disk_t *disk;
[603c1d1f]	377	bool block_inited = false;
	378	size_t block_size;
[28ed0d9]	379	int rc;
	380
	381	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_label_create(%zu)", sid);
	382
[603c1d1f]	383	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_label_create(%zu) - chkdup", sid);
	384
[28ed0d9]	385	/* Check for duplicates */
	386	rc = vbds_disk_by_svcid(sid, &disk);
	387	if (rc == EOK)
	388	return EEXISTS;
	389
[603c1d1f]	390	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_label_create(%zu) - alloc", sid);
	391
[28ed0d9]	392	disk = calloc(1, sizeof(vbds_disk_t));
	393	if (disk == NULL)
	394	return ENOMEM;
	395
[603c1d1f]	396	rc = loc_service_get_name(sid, &disk->svc_name);
	397	if (rc != EOK) {
	398	log_msg(LOG_DEFAULT, LVL_ERROR, "Failed getting disk service name.");
	399	rc = EIO;
	400	goto error;
	401	}
	402
	403	log_msg(LOG_DEFAULT, LVL_NOTE, "block_init(%zu)", sid);
	404	rc = block_init(EXCHANGE_SERIALIZE, sid, 2048);
	405	if (rc != EOK) {
	406	log_msg(LOG_DEFAULT, LVL_ERROR, "Failed opening block device %s.",
	407	disk->svc_name);
	408	rc = EIO;
	409	goto error;
	410	}
	411
	412	rc = block_get_bsize(sid, &block_size);
	413	if (rc != EOK) {
	414	log_msg(LOG_DEFAULT, LVL_ERROR, "Failed getting block size of %s.",
	415	disk->svc_name);
	416	rc = EIO;
	417	goto error;
	418	}
	419
	420	block_inited = true;
	421
	422	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_label_create(%zu) - label_create", sid);
	423
[28ed0d9]	424	rc = label_create(sid, ltype, &label);
	425	if (rc != EOK)
	426	goto error;
	427
	428	disk->svc_id = sid;
	429	disk->label = label;
[603c1d1f]	430	disk->block_size = block_size;
[c02d098]	431	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_label_create: block_size=%zu",
	432	block_size);
[603c1d1f]	433	list_initialize(&disk->parts);
	434
[28ed0d9]	435	list_append(&disk->ldisks, &vbds_disks);
[603c1d1f]	436
	437	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_label_create(%zu) - success", sid);
[28ed0d9]	438	return EOK;
	439	error:
[603c1d1f]	440	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_label_create(%zu) - failure", sid);
	441	if (block_inited) {
	442	log_msg(LOG_DEFAULT, LVL_NOTE, "block_fini(%zu)", sid);
	443	block_fini(sid);
	444	}
	445	if (disk != NULL)
	446	free(disk->svc_name);
[28ed0d9]	447	free(disk);
	448	return rc;
	449	}
	450
	451	int vbds_label_delete(service_id_t sid)
	452	{
	453	vbds_disk_t *disk;
	454	int rc;
	455
	456	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_label_delete(%zu)", sid);
	457
	458	rc = vbds_disk_by_svcid(sid, &disk);
	459	if (rc != EOK)
	460	return rc;
	461
	462	rc = label_destroy(disk->label);
	463	if (rc != EOK) {
	464	log_msg(LOG_DEFAULT, LVL_ERROR, "Failed deleting label.");
	465	return rc;
	466	}
	467
	468	list_remove(&disk->ldisks);
[603c1d1f]	469	log_msg(LOG_DEFAULT, LVL_NOTE, "block_fini(%zu)", sid);
	470	block_fini(sid);
[28ed0d9]	471	free(disk);
	472	return EOK;
	473	}
	474
[6a0d4ce2]	475	int vbds_part_get_info(vbds_part_id_t partid, vbd_part_info_t *pinfo)
[28ed0d9]	476	{
[78d50bd]	477	vbds_part_t *part;
[1626cd4]	478	label_part_info_t lpinfo;
[78d50bd]	479	int rc;
	480
[c43db5f]	481	rc = vbds_part_by_pid(partid, &part);
[78d50bd]	482	if (rc != EOK)
	483	return rc;
	484
[1626cd4]	485	label_part_get_info(part->lpart, &lpinfo);
	486
	487	pinfo->index = lpinfo.index;
[b7a4d06]	488	pinfo->pkind = lpinfo.pkind;
[1626cd4]	489	pinfo->block0 = lpinfo.block0;
	490	pinfo->nblocks = lpinfo.nblocks;
[28ed0d9]	491	return EOK;
	492	}
	493
[6bc542b]	494	int vbds_part_create(service_id_t sid, vbd_part_spec_t *pspec,
	495	vbds_part_id_t *rpart)
[28ed0d9]	496	{
[78d50bd]	497	vbds_disk_t *disk;
	498	vbds_part_t *part;
[6bc542b]	499	label_part_spec_t lpspec;
[78d50bd]	500	label_part_t *lpart;
	501	int rc;
	502
	503	rc = vbds_disk_by_svcid(sid, &disk);
	504	if (rc != EOK) {
[f57ccb5]	505	log_msg(LOG_DEFAULT, LVL_NOTE, "Disk %zu not found",
[78d50bd]	506	sid);
	507	goto error;
	508	}
	509
[6bc542b]	510	label_pspec_init(&lpspec);
	511	lpspec.index = pspec->index;
	512	lpspec.block0 = pspec->block0;
	513	lpspec.nblocks = pspec->nblocks;
[c02d098]	514	lpspec.hdr_blocks = pspec->hdr_blocks;
[b7a4d06]	515	lpspec.pkind = pspec->pkind;
[6bc542b]	516	lpspec.ptype = pspec->ptype;
	517
	518	rc = label_part_create(disk->label, &lpspec, &lpart);
[78d50bd]	519	if (rc != EOK) {
	520	log_msg(LOG_DEFAULT, LVL_ERROR, "Error creating partition.");
	521	goto error;
	522	}
	523
[6439741]	524	rc = vbds_part_indices_update(disk);
	525	if (rc != EOK) {
	526	log_msg(LOG_DEFAULT, LVL_ERROR, "Error updating partition indices");
	527	goto error;
	528	}
	529
[6bc542b]	530	rc = vbds_part_add(disk, lpart, &part);
[78d50bd]	531	if (rc != EOK) {
	532	log_msg(LOG_DEFAULT, LVL_ERROR, "Failed while creating "
	533	"partition.");
	534	rc = label_part_destroy(lpart);
	535	if (rc != EOK)
	536	log_msg(LOG_DEFAULT, LVL_ERROR,
	537	"Cannot roll back partition creation.");
	538	rc = EIO;
	539	goto error;
	540	}
	541
[6bc542b]	542	if (rpart != NULL)
[c43db5f]	543	*rpart = part->pid;
[28ed0d9]	544	return EOK;
[78d50bd]	545	error:
	546	return rc;
[28ed0d9]	547	}
	548
[78d50bd]	549	int vbds_part_delete(vbds_part_id_t partid)
[28ed0d9]	550	{
[78d50bd]	551	vbds_part_t *part;
[99c23405]	552	vbds_disk_t *disk;
	553	label_part_t *lpart;
[78d50bd]	554	int rc;
	555
[c43db5f]	556	rc = vbds_part_by_pid(partid, &part);
[78d50bd]	557	if (rc != EOK)
	558	return rc;
	559
[99c23405]	560	disk = part->disk;
	561
	562	rc = vbds_part_remove(part, &lpart);
[78d50bd]	563	if (rc != EOK)
	564	return rc;
	565
[99c23405]	566	rc = label_part_destroy(lpart);
	567	if (rc != EOK) {
	568	log_msg(LOG_DEFAULT, LVL_ERROR, "Failed deleting partition");
	569
	570	/* Try rolling back */
	571	rc = vbds_part_add(disk, lpart, NULL);
	572	if (rc != EOK)
	573	log_msg(LOG_DEFAULT, LVL_ERROR, "Failed rolling back.");
	574
	575	return EIO;
	576	}
	577
[6439741]	578	rc = vbds_part_indices_update(disk);
	579	if (rc != EOK) {
	580	log_msg(LOG_DEFAULT, LVL_ERROR, "Error updating partition indices");
	581	return EIO;
	582	}
	583
[78d50bd]	584	return EOK;
	585	}
	586
[f57ccb5]	587	int vbds_suggest_ptype(service_id_t sid, label_pcnt_t pcnt,
	588	label_ptype_t *ptype)
	589	{
	590	vbds_disk_t *disk;
	591	int rc;
	592
	593	rc = vbds_disk_by_svcid(sid, &disk);
	594	if (rc != EOK) {
	595	log_msg(LOG_DEFAULT, LVL_NOTE, "Disk %zu not found",
	596	sid);
	597	goto error;
	598	}
	599
	600	rc = label_suggest_ptype(disk->label, pcnt, ptype);
	601	if (rc != EOK) {
	602	log_msg(LOG_DEFAULT, LVL_NOTE, "label_suggest_ptype() failed");
	603	goto error;
	604	}
	605
	606	return EOK;
	607	error:
	608	return rc;
	609	}
	610
[78d50bd]	611	static int vbds_bd_open(bd_srvs_t bds, bd_srv_t bd)
	612	{
	613	vbds_part_t *part = bd_srv_part(bd);
	614
	615	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_bd_open()");
	616	part->open_cnt++;
	617	return EOK;
	618	}
	619
	620	static int vbds_bd_close(bd_srv_t *bd)
	621	{
	622	vbds_part_t *part = bd_srv_part(bd);
	623
	624	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_bd_close()");
	625	part->open_cnt--;
	626	return EOK;
	627	}
	628
	629	static int vbds_bd_read_blocks(bd_srv_t *bd, aoff64_t ba, size_t cnt,
	630	void *buf, size_t size)
	631	{
	632	vbds_part_t *part = bd_srv_part(bd);
	633	aoff64_t gba;
	634
	635	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_bd_read_blocks()");
	636
	637	if (cnt * part->disk->block_size < size)
	638	return EINVAL;
	639
	640	if (vbds_bsa_translate(part, ba, cnt, &gba) != EOK)
	641	return ELIMIT;
	642
	643	return block_read_direct(part->disk->svc_id, gba, cnt, buf);
	644	}
	645
	646	static int vbds_bd_sync_cache(bd_srv_t *bd, aoff64_t ba, size_t cnt)
	647	{
	648	vbds_part_t *part = bd_srv_part(bd);
	649	aoff64_t gba;
	650
	651	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_bd_sync_cache()");
	652
	653	/* XXX Allow full-disk sync? */
	654	if (ba != 0 \|\| cnt != 0) {
	655	if (vbds_bsa_translate(part, ba, cnt, &gba) != EOK)
	656	return ELIMIT;
	657	} else {
	658	gba = 0;
	659	}
	660
	661	return block_sync_cache(part->disk->svc_id, gba, cnt);
	662	}
	663
	664	static int vbds_bd_write_blocks(bd_srv_t *bd, aoff64_t ba, size_t cnt,
	665	const void *buf, size_t size)
	666	{
	667	vbds_part_t *part = bd_srv_part(bd);
	668	aoff64_t gba;
	669
	670	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_bd_write_blocks()");
	671
	672	if (cnt * part->disk->block_size < size)
	673	return EINVAL;
	674
	675	if (vbds_bsa_translate(part, ba, cnt, &gba) != EOK)
	676	return ELIMIT;
	677
	678	return block_write_direct(part->disk->svc_id, gba, cnt, buf);
	679	}
	680
	681	static int vbds_bd_get_block_size(bd_srv_t bd, size_t rsize)
	682	{
[3faa03d]	683	vbds_part_t *part = bd_srv_part(bd);
	684
[78d50bd]	685	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_bd_get_block_size()");
[3faa03d]	686	*rsize = part->disk->block_size;
[78d50bd]	687	return EOK;
	688	}
	689
	690	static int vbds_bd_get_num_blocks(bd_srv_t bd, aoff64_t rnb)
	691	{
[3faa03d]	692	vbds_part_t *part = bd_srv_part(bd);
	693
[78d50bd]	694	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_bd_get_num_blocks()");
[3faa03d]	695	*rnb = part->nblocks;
[78d50bd]	696	return EOK;
	697	}
	698
	699	void vbds_bd_conn(ipc_callid_t iid, ipc_call_t icall, void arg)
	700	{
	701	vbds_part_t *part;
	702	int rc;
[c43db5f]	703	service_id_t svcid;
[78d50bd]	704
[3faa03d]	705	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_bd_conn()");
	706
[c43db5f]	707	svcid = IPC_GET_ARG1(*icall);
[78d50bd]	708
[c43db5f]	709	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_bd_conn() - svcid=%zu", svcid);
[3faa03d]	710
[c43db5f]	711	rc = vbds_part_by_svcid(svcid, &part);
[78d50bd]	712	if (rc != EOK) {
[3faa03d]	713	log_msg(LOG_DEFAULT, LVL_NOTE, "vbd_bd_conn() - partition "
	714	"not found.");
[78d50bd]	715	async_answer_0(iid, EINVAL);
	716	return;
	717	}
	718
[3faa03d]	719	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_bd_conn() - call bd_conn");
[78d50bd]	720	bd_conn(iid, icall, &part->bds);
	721	}
	722
	723	/** Translate block segment address with range checking. */
	724	static int vbds_bsa_translate(vbds_part_t *part, aoff64_t ba, size_t cnt,
	725	aoff64_t *gba)
	726	{
	727	if (ba + cnt > part->nblocks)
	728	return ELIMIT;
	729
	730	*gba = part->block0 + ba;
[28ed0d9]	731	return EOK;
	732	}
	733
[6439741]	734	/** Register service for partition */
	735	static int vbds_part_svc_register(vbds_part_t *part)
	736	{
	737	char *name;
	738	service_id_t psid;
	739	int idx;
	740	int rc;
	741
	742	idx = part->lpart->index;
	743
	744	rc = asprintf(&name, "%sp%u", part->disk->svc_name, idx);
	745	if (rc < 0) {
	746	log_msg(LOG_DEFAULT, LVL_ERROR, "Out of memory.");
	747	return ENOMEM;
	748	}
	749
	750	rc = loc_service_register(name, &psid);
	751	if (rc != EOK) {
	752	log_msg(LOG_DEFAULT, LVL_ERROR, "Failed registering "
	753	"service %s.", name);
	754	free(name);
	755	free(part);
	756	return EIO;
	757	}
	758
	759	free(name);
	760	part->svc_id = psid;
	761	part->reg_idx = idx;
	762	return EOK;
	763	}
	764
	765	/** Unregister service for partition */
	766	static int vbds_part_svc_unregister(vbds_part_t *part)
	767	{
	768	int rc;
	769
	770	rc = loc_service_unregister(part->svc_id);
	771	if (rc != EOK)
	772	return EIO;
	773
	774	part->svc_id = 0;
	775	part->reg_idx = 0;
	776	return EOK;
	777	}
	778
	779	/** Update service names for any partition whose index has changed. */
	780	static int vbds_part_indices_update(vbds_disk_t *disk)
	781	{
	782	label_part_info_t lpinfo;
	783	int rc;
	784
	785	log_msg(LOG_DEFAULT, LVL_NOTE, "vbds_part_indices_update()");
	786
	787	/* First unregister services for partitions whose index has changed */
	788	list_foreach(disk->parts, ldisk, vbds_part_t, part) {
	789	if (part->svc_id != 0 && part->lpart->index != part->reg_idx) {
	790	rc = vbds_part_svc_unregister(part);
	791	if (rc != EOK) {
	792	log_msg(LOG_DEFAULT, LVL_NOTE, "Error "
	793	"un-registering partition.");
	794	return EIO;
	795	}
	796	}
	797	}
	798
	799	/* Now re-register those services under the new indices */
	800	list_foreach(disk->parts, ldisk, vbds_part_t, part) {
	801	label_part_get_info(part->lpart, &lpinfo);
	802	if (part->svc_id == 0 && lpinfo.pkind != lpk_extended) {
	803	rc = vbds_part_svc_register(part);
	804	if (rc != EOK) {
	805	log_msg(LOG_DEFAULT, LVL_NOTE, "Error "
	806	"re-registering partition.");
	807	return EIO;
	808	}
	809	}
	810	}
	811
	812	return EOK;
	813	}
	814
[28ed0d9]	815	/** @}
	816	*/

Note: See TracBrowser for help on using the repository browser.

Download in other formats: