summaryrefslogtreecommitdiffstats
diff options
context:
space:
mode:
Diffstat
-rw-r--r--sys/geom/part/g_part_ebr.c49
-rw-r--r--sys/geom/part/g_part_mbr.c47
-rw-r--r--sys/geom/part/g_part_pc98.c47
-rw-r--r--sys/geom/part/g_part_vtoc8.c30
4 files changed, 93 insertions, 80 deletions
diff --git a/sys/geom/part/g_part_ebr.c b/sys/geom/part/g_part_ebr.c
index a8a940d..dfeda58 100644
--- a/sys/geom/part/g_part_ebr.c
+++ b/sys/geom/part/g_part_ebr.c
@@ -220,47 +220,54 @@ ebr_set_chs(struct g_part_table *table, uint32_t lba, u_char *cylp, u_char *hdp,
}
static int
+ebr_align(struct g_part_table *basetable, uint32_t *start, uint32_t *size)
+{
+ uint32_t sectors;
+
+ sectors = basetable->gpt_sectors;
+ if (*size < 2 * sectors)
+ return (EINVAL);
+ if (*start % sectors) {
+ *size += (*start % sectors) - sectors;
+ *start -= (*start % sectors) - sectors;
+ }
+ if (*size % sectors)
+ *size -= (*size % sectors);
+ if (*size < 2 * sectors)
+ return (EINVAL);
+ return (0);
+}
+
+
+static int
g_part_ebr_add(struct g_part_table *basetable, struct g_part_entry *baseentry,
struct g_part_parms *gpp)
{
- struct g_geom *gp;
struct g_provider *pp;
struct g_part_ebr_entry *entry;
- uint32_t start, size, sectors;
+ uint32_t start, size;
if (gpp->gpp_parms & G_PART_PARM_LABEL)
return (EINVAL);
- gp = basetable->gpt_gp;
- pp = LIST_FIRST(&gp->consumer)->provider;
- sectors = basetable->gpt_sectors;
-
+ pp = LIST_FIRST(&basetable->gpt_gp->consumer)->provider;
entry = (struct g_part_ebr_entry *)baseentry;
-
start = gpp->gpp_start;
size = gpp->gpp_size;
- if (size < 2 * sectors)
- return (EINVAL);
- if (start % sectors) {
- size = size - sectors + (start % sectors);
- start = start - (start % sectors) + sectors;
- }
- if (size % sectors)
- size = size - (size % sectors);
- if (size < 2 * sectors)
+ if (ebr_align(basetable, &start, &size) != 0)
return (EINVAL);
-
if (baseentry->gpe_deleted)
bzero(&entry->ent, sizeof(entry->ent));
KASSERT(baseentry->gpe_start <= start, ("%s", __func__));
KASSERT(baseentry->gpe_end >= start + size - 1, ("%s", __func__));
- baseentry->gpe_index = (start / sectors) + 1;
- baseentry->gpe_offset = (off_t)(start + sectors) * pp->sectorsize;
+ baseentry->gpe_index = (start / basetable->gpt_sectors) + 1;
+ baseentry->gpe_offset =
+ (off_t)(start + basetable->gpt_sectors) * pp->sectorsize;
baseentry->gpe_start = start;
baseentry->gpe_end = start + size - 1;
- entry->ent.dp_start = sectors;
- entry->ent.dp_size = size - sectors;
+ entry->ent.dp_start = basetable->gpt_sectors;
+ entry->ent.dp_size = size - basetable->gpt_sectors;
ebr_set_chs(basetable, entry->ent.dp_start, &entry->ent.dp_scyl,
&entry->ent.dp_shd, &entry->ent.dp_ssect);
ebr_set_chs(basetable, baseentry->gpe_end, &entry->ent.dp_ecyl,
diff --git a/sys/geom/part/g_part_mbr.c b/sys/geom/part/g_part_mbr.c
index e9085b1..55fc789 100644
--- a/sys/geom/part/g_part_mbr.c
+++ b/sys/geom/part/g_part_mbr.c
@@ -195,34 +195,39 @@ mbr_set_chs(struct g_part_table *table, uint32_t lba, u_char *cylp, u_char *hdp,
}
static int
+mbr_align(struct g_part_table *basetable, uint32_t *start, uint32_t *size)
+{
+ uint32_t sectors;
+
+ sectors = basetable->gpt_sectors;
+ if (*size < sectors)
+ return (EINVAL);
+ if (start != NULL && (*start % sectors)) {
+ *size += (*start % sectors) - sectors;
+ *start -= (*start % sectors) - sectors;
+ }
+ if (*size % sectors)
+ *size -= (*size % sectors);
+ if (*size < sectors)
+ return (EINVAL);
+ return (0);
+}
+
+static int
g_part_mbr_add(struct g_part_table *basetable, struct g_part_entry *baseentry,
struct g_part_parms *gpp)
{
struct g_part_mbr_entry *entry;
- struct g_part_mbr_table *table;
- uint32_t start, size, sectors;
+ uint32_t start, size;
if (gpp->gpp_parms & G_PART_PARM_LABEL)
return (EINVAL);
- sectors = basetable->gpt_sectors;
-
entry = (struct g_part_mbr_entry *)baseentry;
- table = (struct g_part_mbr_table *)basetable;
-
start = gpp->gpp_start;
size = gpp->gpp_size;
- if (size < sectors)
- return (EINVAL);
- if (start % sectors) {
- size = size - sectors + (start % sectors);
- start = start - (start % sectors) + sectors;
- }
- if (size % sectors)
- size = size - (size % sectors);
- if (size < sectors)
+ if (mbr_align(basetable, &start, &size) != 0)
return (EINVAL);
-
if (baseentry->gpe_deleted)
bzero(&entry->ent, sizeof(entry->ent));
@@ -337,7 +342,7 @@ g_part_mbr_resize(struct g_part_table *basetable,
{
struct g_part_mbr_entry *entry;
struct g_provider *pp;
- uint32_t size, sectors;
+ uint32_t size;
if (baseentry == NULL) {
pp = LIST_FIRST(&basetable->gpt_gp->consumer)->provider;
@@ -345,14 +350,8 @@ g_part_mbr_resize(struct g_part_table *basetable,
UINT32_MAX) - 1;
return (0);
}
- sectors = basetable->gpt_sectors;
size = gpp->gpp_size;
-
- if (size < sectors)
- return (EINVAL);
- if (size % sectors)
- size = size - (size % sectors);
- if (size < sectors)
+ if (mbr_align(basetable, NULL, &size) != 0)
return (EINVAL);
entry = (struct g_part_mbr_entry *)baseentry;
diff --git a/sys/geom/part/g_part_pc98.c b/sys/geom/part/g_part_pc98.c
index bd59431..9fc6b2a 100644
--- a/sys/geom/part/g_part_pc98.c
+++ b/sys/geom/part/g_part_pc98.c
@@ -175,32 +175,37 @@ pc98_set_chs(struct g_part_table *table, uint32_t lba, u_short *cylp,
}
static int
+pc98_align(struct g_part_table *basetable, uint32_t *start, uint32_t *size)
+{
+ uint32_t cyl;
+
+ cyl = basetable->gpt_heads * basetable->gpt_sectors;
+ if (*size < cyl)
+ return (EINVAL);
+ if (start != NULL && (*start % cyl)) {
+ *size += (*start % cyl) - cyl;
+ *start -= (*start % cyl) - cyl;
+ }
+ if (*size % cyl)
+ *size -= (*size % cyl);
+ if (*size < cyl)
+ return (EINVAL);
+ return (0);
+}
+
+static int
g_part_pc98_add(struct g_part_table *basetable, struct g_part_entry *baseentry,
struct g_part_parms *gpp)
{
struct g_part_pc98_entry *entry;
- struct g_part_pc98_table *table;
- uint32_t cyl, start, size;
+ uint32_t start, size;
int error;
- cyl = basetable->gpt_heads * basetable->gpt_sectors;
-
entry = (struct g_part_pc98_entry *)baseentry;
- table = (struct g_part_pc98_table *)basetable;
-
start = gpp->gpp_start;
size = gpp->gpp_size;
- if (size < cyl)
- return (EINVAL);
- if (start % cyl) {
- size = size - cyl + (start % cyl);
- start = start - (start % cyl) + cyl;
- }
- if (size % cyl)
- size = size - (size % cyl);
- if (size < cyl)
+ if (pc98_align(basetable, &start, &size) != 0)
return (EINVAL);
-
if (baseentry->gpe_deleted)
bzero(&entry->ent, sizeof(entry->ent));
else
@@ -344,7 +349,7 @@ g_part_pc98_resize(struct g_part_table *basetable,
{
struct g_part_pc98_entry *entry;
struct g_provider *pp;
- uint32_t size, cyl;
+ uint32_t size;
if (baseentry == NULL) {
pp = LIST_FIRST(&basetable->gpt_gp->consumer)->provider;
@@ -352,14 +357,8 @@ g_part_pc98_resize(struct g_part_table *basetable,
UINT32_MAX) - 1;
return (0);
}
- cyl = basetable->gpt_heads * basetable->gpt_sectors;
size = gpp->gpp_size;
-
- if (size < cyl)
- return (EINVAL);
- if (size % cyl)
- size = size - (size % cyl);
- if (size < cyl)
+ if (pc98_align(basetable, NULL, &size) != 0)
return (EINVAL);
entry = (struct g_part_pc98_entry *)baseentry;
diff --git a/sys/geom/part/g_part_vtoc8.c b/sys/geom/part/g_part_vtoc8.c
index 833eceb..f40052b 100644
--- a/sys/geom/part/g_part_vtoc8.c
+++ b/sys/geom/part/g_part_vtoc8.c
@@ -143,6 +143,23 @@ vtoc8_parse_type(const char *type, uint16_t *tag)
}
static int
+vtoc8_align(struct g_part_vtoc8_table *table, uint64_t *start, uint64_t *size)
+{
+
+ if (*size < table->secpercyl)
+ return (EINVAL);
+ if (start != NULL && (*start % table->secpercyl)) {
+ *size += (*start % table->secpercyl) - table->secpercyl;
+ *start -= (*start % table->secpercyl) - table->secpercyl;
+ }
+ if (*size % table->secpercyl)
+ *size -= (*size % table->secpercyl);
+ if (*size < table->secpercyl)
+ return (EINVAL);
+ return (0);
+}
+
+static int
g_part_vtoc8_add(struct g_part_table *basetable, struct g_part_entry *entry,
struct g_part_parms *gpp)
{
@@ -160,16 +177,9 @@ g_part_vtoc8_add(struct g_part_table *basetable, struct g_part_entry *entry,
table = (struct g_part_vtoc8_table *)basetable;
index = entry->gpe_index - 1;
-
start = gpp->gpp_start;
size = gpp->gpp_size;
- if (start % table->secpercyl) {
- size = size - table->secpercyl + (start % table->secpercyl);
- start = start - (start % table->secpercyl) + table->secpercyl;
- }
- if (size % table->secpercyl)
- size = size - (size % table->secpercyl);
- if (size < table->secpercyl)
+ if (vtoc8_align(table, &start, &size) != 0)
return (EINVAL);
KASSERT(entry->gpe_start <= start, (__func__));
@@ -355,9 +365,7 @@ g_part_vtoc8_resize(struct g_part_table *basetable,
}
table = (struct g_part_vtoc8_table *)basetable;
size = gpp->gpp_size;
- if (size % table->secpercyl)
- size = size - (size % table->secpercyl);
- if (size < table->secpercyl)
+ if (vtoc8_align(table, NULL, &size) != 0)
return (EINVAL);
entry->gpe_end = entry->gpe_start + size - 1;
OpenPOWER on IntegriCloud