forked from speed-dreams/speed-dreams-code
Re #308 Fixed code indentation
git-svn-id: https://svn.code.sf.net/p/speed-dreams/code/trunk@3890 30fe4595-0a0c-4342-8851-515496e4dcbd Former-commit-id: 97858842ab95206c83ed01539dc6f8a6454152aa Former-commit-id: ad627768ee629c4d700673755dcf9c081d189aa2
This commit is contained in:
pouillot
parent
11d71ccdd5
commit
58e4df4089
1 changed files with 335 additions and 335 deletions
|
|
@ -1272,399 +1272,399 @@ CreateSegRing(void *TrackHandle, tTrack *theTrack, tTrackSeg *start, tTrackSeg *
|
||||||
// TODO: is the (int) intended?
|
// TODO: is the (int) intended?
|
||||||
DoVfactor = (float) ((int) GfParmGetCurNum(TrackHandle, path, TRK_ATT_DOVFACTOR, (char*)NULL, 1.0)) ;
|
DoVfactor = (float) ((int) GfParmGetCurNum(TrackHandle, path, TRK_ATT_DOVFACTOR, (char*)NULL, 1.0)) ;
|
||||||
|
|
||||||
/* get segment type and lenght */
|
/* get segment type and lenght */
|
||||||
if (strcmp(segtype, TRK_VAL_STR) == 0) {
|
if (strcmp(segtype, TRK_VAL_STR) == 0) {
|
||||||
/* straight */
|
/* straight */
|
||||||
length = GfParmGetCurNum(TrackHandle, path, TRK_ATT_LG, (char*)NULL, 0);
|
length = GfParmGetCurNum(TrackHandle, path, TRK_ATT_LG, (char*)NULL, 0);
|
||||||
type = TR_STR;
|
type = TR_STR;
|
||||||
radius = radiusend = 0;
|
radius = radiusend = 0;
|
||||||
} else if (strcmp(segtype, TRK_VAL_LFT) == 0) {
|
} else if (strcmp(segtype, TRK_VAL_LFT) == 0) {
|
||||||
/* left curve */
|
/* left curve */
|
||||||
radius = GfParmGetCurNum(TrackHandle, path, TRK_ATT_RADIUS, (char*)NULL, 0);
|
radius = GfParmGetCurNum(TrackHandle, path, TRK_ATT_RADIUS, (char*)NULL, 0);
|
||||||
radiusend = GfParmGetCurNum(TrackHandle, path, TRK_ATT_RADIUSEND, (char*)NULL, radius);
|
radiusend = GfParmGetCurNum(TrackHandle, path, TRK_ATT_RADIUSEND, (char*)NULL, radius);
|
||||||
arc = GfParmGetCurNum(TrackHandle, path, TRK_ATT_ARC, (char*)NULL, 0);
|
arc = GfParmGetCurNum(TrackHandle, path, TRK_ATT_ARC, (char*)NULL, 0);
|
||||||
type = TR_LFT;
|
type = TR_LFT;
|
||||||
length = (tdble)((radius + radiusend) / 2.0 * arc);
|
length = (tdble)((radius + radiusend) / 2.0 * arc);
|
||||||
} else if (strcmp(segtype, TRK_VAL_RGT) == 0) {
|
} else if (strcmp(segtype, TRK_VAL_RGT) == 0) {
|
||||||
/* right curve */
|
/* right curve */
|
||||||
radius = GfParmGetCurNum(TrackHandle, path, TRK_ATT_RADIUS, (char*)NULL, 0);
|
radius = GfParmGetCurNum(TrackHandle, path, TRK_ATT_RADIUS, (char*)NULL, 0);
|
||||||
radiusend = GfParmGetCurNum(TrackHandle, path, TRK_ATT_RADIUSEND, (char*)NULL, radius);
|
radiusend = GfParmGetCurNum(TrackHandle, path, TRK_ATT_RADIUSEND, (char*)NULL, radius);
|
||||||
arc = GfParmGetCurNum(TrackHandle, path, TRK_ATT_ARC, (char*)NULL, 0);
|
arc = GfParmGetCurNum(TrackHandle, path, TRK_ATT_ARC, (char*)NULL, 0);
|
||||||
type = TR_RGT;
|
type = TR_RGT;
|
||||||
length = (tdble)((radius + radiusend) / 2.0 * arc);
|
length = (tdble)((radius + radiusend) / 2.0 * arc);
|
||||||
}
|
}
|
||||||
segName = GfParmListGetCurEltName(TrackHandle, path);
|
segName = GfParmListGetCurEltName(TrackHandle, path);
|
||||||
if (ext) {
|
if (ext) {
|
||||||
if (GfHashGetStr(segNameHash, segName)) {
|
if (GfHashGetStr(segNameHash, segName)) {
|
||||||
printf(">>>>>>>>> DUPLICATED SEGMENT NAME \"%s\" PLEASE CHANGE IT !!!!\n", segName);
|
printf(">>>>>>>>> DUPLICATED SEGMENT NAME \"%s\" PLEASE CHANGE IT !!!!\n", segName);
|
||||||
exit(1);
|
exit(1);
|
||||||
}
|
}
|
||||||
GfHashAddStr(segNameHash, segName, segName);
|
GfHashAddStr(segNameHash, segName, segName);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* elevation and banking */
|
/* elevation and banking */
|
||||||
zsl = GfParmGetCurNum(TrackHandle, path, TRK_ATT_ZSL, (char*)NULL, zsl);
|
zsl = GfParmGetCurNum(TrackHandle, path, TRK_ATT_ZSL, (char*)NULL, zsl);
|
||||||
zsr = GfParmGetCurNum(TrackHandle, path, TRK_ATT_ZSR, (char*)NULL, zsr);
|
zsr = GfParmGetCurNum(TrackHandle, path, TRK_ATT_ZSR, (char*)NULL, zsr);
|
||||||
zel = GfParmGetCurNum(TrackHandle, path, TRK_ATT_ZEL, (char*)NULL, zel);
|
zel = GfParmGetCurNum(TrackHandle, path, TRK_ATT_ZEL, (char*)NULL, zel);
|
||||||
zer = GfParmGetCurNum(TrackHandle, path, TRK_ATT_ZER, (char*)NULL, zer);
|
zer = GfParmGetCurNum(TrackHandle, path, TRK_ATT_ZER, (char*)NULL, zer);
|
||||||
ze = zs = -100000.0;
|
ze = zs = -100000.0;
|
||||||
ze = GfParmGetCurNum(TrackHandle, path, TRK_ATT_ZE, (char*)NULL, ze);
|
ze = GfParmGetCurNum(TrackHandle, path, TRK_ATT_ZE, (char*)NULL, ze);
|
||||||
zs = GfParmGetCurNum(TrackHandle, path, TRK_ATT_ZS, (char*)NULL, zs);
|
zs = GfParmGetCurNum(TrackHandle, path, TRK_ATT_ZS, (char*)NULL, zs);
|
||||||
grade = GfParmGetCurNum(TrackHandle, path, TRK_ATT_GRADE, (char*)NULL, grade);
|
grade = GfParmGetCurNum(TrackHandle, path, TRK_ATT_GRADE, (char*)NULL, grade);
|
||||||
if (zs != -100000.0) {
|
if (zs != -100000.0) {
|
||||||
zsr = zsl = zs;
|
zsr = zsl = zs;
|
||||||
} else {
|
} else {
|
||||||
zs = (tdble)((zsl + zsr) / 2.0);
|
zs = (tdble)((zsl + zsr) / 2.0);
|
||||||
}
|
}
|
||||||
if (ze != -100000.0) {
|
if (ze != -100000.0) {
|
||||||
zer = zel = ze;
|
zer = zel = ze;
|
||||||
} else if (grade != -100000.0) {
|
} else if (grade != -100000.0) {
|
||||||
ze = zs + length * grade;
|
ze = zs + length * grade;
|
||||||
} else {
|
} else {
|
||||||
ze = (tdble)((zel + zer) / 2.0);
|
ze = (tdble)((zel + zer) / 2.0);
|
||||||
}
|
}
|
||||||
bankings = atan2(zsl - zsr, width);
|
bankings = atan2(zsl - zsr, width);
|
||||||
bankinge = atan2(zel - zer, width);
|
bankinge = atan2(zel - zer, width);
|
||||||
bankings = GfParmGetCurNum(TrackHandle, path, TRK_ATT_BKS, (char*)NULL, bankings);
|
bankings = GfParmGetCurNum(TrackHandle, path, TRK_ATT_BKS, (char*)NULL, bankings);
|
||||||
bankinge = GfParmGetCurNum(TrackHandle, path, TRK_ATT_BKE, (char*)NULL, bankinge);
|
bankinge = GfParmGetCurNum(TrackHandle, path, TRK_ATT_BKE, (char*)NULL, bankinge);
|
||||||
dz = (tdble)(tan(bankings) * width / 2.0);
|
dz = (tdble)(tan(bankings) * width / 2.0);
|
||||||
zsl = zs + dz;
|
zsl = zs + dz;
|
||||||
zsr = zs - dz;
|
zsr = zs - dz;
|
||||||
dz = (tdble)(tan(bankinge) * width / 2.0);
|
dz = (tdble)(tan(bankinge) * width / 2.0);
|
||||||
zel = ze + dz;
|
zel = ze + dz;
|
||||||
zer = ze - dz;
|
zer = ze - dz;
|
||||||
|
|
||||||
TSTZ(zsl);
|
TSTZ(zsl);
|
||||||
TSTZ(zsr);
|
TSTZ(zsr);
|
||||||
|
|
||||||
/* Get segment profil */
|
/* Get segment profil */
|
||||||
profil = GfParmGetCurStr(TrackHandle, path, TRK_ATT_PROFIL, TRK_VAL_SPLINE);
|
profil = GfParmGetCurStr(TrackHandle, path, TRK_ATT_PROFIL, TRK_VAL_SPLINE);
|
||||||
stgtl = etgtl;
|
stgtl = etgtl;
|
||||||
stgtr = etgtr;
|
stgtr = etgtr;
|
||||||
if (strcmp(profil, TRK_VAL_SPLINE) == 0) {
|
if (strcmp(profil, TRK_VAL_SPLINE) == 0) {
|
||||||
steps = (int)GfParmGetCurNum(TrackHandle, path, TRK_ATT_PROFSTEPS, (char*)NULL, 1.0);
|
steps = (int)GfParmGetCurNum(TrackHandle, path, TRK_ATT_PROFSTEPS, (char*)NULL, 1.0);
|
||||||
if (steps == 1) {
|
if (steps == 1) {
|
||||||
stepslg = GfParmGetCurNum(TrackHandle, path, TRK_ATT_PROFSTEPSLEN, (char*)NULL, GlobalStepLen);
|
stepslg = GfParmGetCurNum(TrackHandle, path, TRK_ATT_PROFSTEPSLEN, (char*)NULL, GlobalStepLen);
|
||||||
if (stepslg) {
|
if (stepslg) {
|
||||||
steps = (int)(length / stepslg) + 1;
|
steps = (int)(length / stepslg) + 1;
|
||||||
} else {
|
} else {
|
||||||
steps = 1;
|
steps = 1;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
stgtl = GfParmGetCurNum(TrackHandle, path, TRK_ATT_PROFTGTSL, (char*)NULL, stgtl);
|
stgtl = GfParmGetCurNum(TrackHandle, path, TRK_ATT_PROFTGTSL, (char*)NULL, stgtl);
|
||||||
etgtl = GfParmGetCurNum(TrackHandle, path, TRK_ATT_PROFTGTEL, (char*)NULL, etgtl);
|
etgtl = GfParmGetCurNum(TrackHandle, path, TRK_ATT_PROFTGTEL, (char*)NULL, etgtl);
|
||||||
stgtr = GfParmGetCurNum(TrackHandle, path, TRK_ATT_PROFTGTSR, (char*)NULL, stgtr);
|
stgtr = GfParmGetCurNum(TrackHandle, path, TRK_ATT_PROFTGTSR, (char*)NULL, stgtr);
|
||||||
etgtr = GfParmGetCurNum(TrackHandle, path, TRK_ATT_PROFTGTER, (char*)NULL, etgtr);
|
etgtr = GfParmGetCurNum(TrackHandle, path, TRK_ATT_PROFTGTER, (char*)NULL, etgtr);
|
||||||
stgt = etgt = -100000.0;
|
stgt = etgt = -100000.0;
|
||||||
stgt = GfParmGetCurNum(TrackHandle, path, TRK_ATT_PROFTGTS, (char*)NULL, stgt);
|
stgt = GfParmGetCurNum(TrackHandle, path, TRK_ATT_PROFTGTS, (char*)NULL, stgt);
|
||||||
etgt = GfParmGetCurNum(TrackHandle, path, TRK_ATT_PROFTGTE, (char*)NULL, etgt);
|
etgt = GfParmGetCurNum(TrackHandle, path, TRK_ATT_PROFTGTE, (char*)NULL, etgt);
|
||||||
if (stgt != -100000.0) {
|
if (stgt != -100000.0) {
|
||||||
stgtl = stgtr = stgt;
|
stgtl = stgtr = stgt;
|
||||||
}
|
}
|
||||||
if (etgt != -100000.0) {
|
if (etgt != -100000.0) {
|
||||||
etgtl = etgtr = etgt;
|
etgtl = etgtr = etgt;
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
steps = 1;
|
steps = 1;
|
||||||
stgtl = etgtl = (zel - zsl) / length;
|
stgtl = etgtl = (zel - zsl) / length;
|
||||||
stgtr = etgtr = (zer - zsr) / length;
|
stgtr = etgtr = (zer - zsr) / length;
|
||||||
}
|
}
|
||||||
GfParmSetCurNum(TrackHandle, path, TRK_ATT_ID, (char*)NULL, (tdble)curindex);
|
GfParmSetCurNum(TrackHandle, path, TRK_ATT_ID, (char*)NULL, (tdble)curindex);
|
||||||
|
|
||||||
dzl = zel - zsl;
|
dzl = zel - zsl;
|
||||||
dzr = zer - zsr;
|
dzr = zer - zsr;
|
||||||
T1l = stgtl * length;
|
T1l = stgtl * length;
|
||||||
T2l = etgtl * length;
|
T2l = etgtl * length;
|
||||||
tl = 0.0;
|
tl = 0.0;
|
||||||
dtl = (tdble)(1.0 / steps);
|
dtl = (tdble)(1.0 / steps);
|
||||||
T1r = stgtr * length;
|
T1r = stgtr * length;
|
||||||
T2r = etgtr * length;
|
T2r = etgtr * length;
|
||||||
tr = 0.0;
|
tr = 0.0;
|
||||||
dtr = (tdble)(1.0 / steps);
|
dtr = (tdble)(1.0 / steps);
|
||||||
|
|
||||||
curStep = 0;
|
curStep = 0;
|
||||||
curzel = zsl;
|
curzel = zsl;
|
||||||
curzer = zsr;
|
curzer = zsr;
|
||||||
curArc = arc / (tdble)steps;
|
curArc = arc / (tdble)steps;
|
||||||
curLength = length / (tdble)steps;
|
curLength = length / (tdble)steps;
|
||||||
dradius = (radiusend - radius) / (tdble)steps;
|
dradius = (radiusend - radius) / (tdble)steps;
|
||||||
if (radiusend != radius) {
|
if (radiusend != radius) {
|
||||||
/* Compute the correct curLength... */
|
/* Compute the correct curLength... */
|
||||||
if (steps != 1) {
|
if (steps != 1) {
|
||||||
dradius = (radiusend - radius) / (tdble)(steps - 1);
|
dradius = (radiusend - radius) / (tdble)(steps - 1);
|
||||||
tdble tmpAngle = 0;
|
tdble tmpAngle = 0;
|
||||||
tdble tmpRadius = radius;
|
tdble tmpRadius = radius;
|
||||||
for (curStep = 0; curStep < steps; curStep++) {
|
for (curStep = 0; curStep < steps; curStep++) {
|
||||||
tmpAngle += curLength / tmpRadius;
|
tmpAngle += curLength / tmpRadius;
|
||||||
tmpRadius += dradius;
|
tmpRadius += dradius;
|
||||||
}
|
}
|
||||||
curLength *= arc / tmpAngle;
|
curLength *= arc / tmpAngle;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
curStep = 0;
|
curStep = 0;
|
||||||
|
|
||||||
while (curStep < steps) {
|
while (curStep < steps) {
|
||||||
|
|
||||||
tl += dtl;
|
tl += dtl;
|
||||||
tr += dtr;
|
tr += dtr;
|
||||||
|
|
||||||
curzsl = curzel;
|
curzsl = curzel;
|
||||||
curzel = TrackSpline(zsl, zel, T1l, T2l, tl);
|
curzel = TrackSpline(zsl, zel, T1l, T2l, tl);
|
||||||
|
|
||||||
curzsr = curzer;
|
curzsr = curzer;
|
||||||
curzer = TrackSpline(zsr, zer, T1r, T2r, tr);
|
curzer = TrackSpline(zsr, zer, T1r, T2r, tr);
|
||||||
|
|
||||||
if (dradius != 0) {
|
if (dradius != 0) {
|
||||||
curArc = curLength / radius;
|
curArc = curLength / radius;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* allocate a new segment */
|
/* allocate a new segment */
|
||||||
curSeg = (tTrackSeg*)calloc(1, sizeof(tTrackSeg));
|
curSeg = (tTrackSeg*)calloc(1, sizeof(tTrackSeg));
|
||||||
if (root == NULL) {
|
if (root == NULL) {
|
||||||
root = curSeg;
|
root = curSeg;
|
||||||
curSeg->next = curSeg;
|
curSeg->next = curSeg;
|
||||||
curSeg->prev = curSeg;
|
curSeg->prev = curSeg;
|
||||||
} else {
|
} else {
|
||||||
curSeg->next = root->next;
|
curSeg->next = root->next;
|
||||||
curSeg->next->prev = curSeg;
|
curSeg->next->prev = curSeg;
|
||||||
curSeg->prev = root;
|
curSeg->prev = root;
|
||||||
root->next = curSeg;
|
root->next = curSeg;
|
||||||
root = curSeg;
|
root = curSeg;
|
||||||
}
|
}
|
||||||
curSeg->type2 = TR_MAIN;
|
curSeg->type2 = TR_MAIN;
|
||||||
curSeg->name = segName;
|
curSeg->name = segName;
|
||||||
curSeg->id = curindex;
|
curSeg->id = curindex;
|
||||||
curSeg->width = curSeg->startWidth = curSeg->endWidth = width;
|
curSeg->width = curSeg->startWidth = curSeg->endWidth = width;
|
||||||
curSeg->surface = surface;
|
curSeg->surface = surface;
|
||||||
curSeg->envIndex = envIndex;
|
curSeg->envIndex = envIndex;
|
||||||
curSeg->DoVfactor = DoVfactor;
|
curSeg->DoVfactor = DoVfactor;
|
||||||
/*printf("curseg id =%d factor =%f\n",curSeg->id,curSeg->DoVfactor);*/
|
/*printf("curseg id =%d factor =%f\n",curSeg->id,curSeg->DoVfactor);*/
|
||||||
curSeg->lgfromstart = totLength;
|
curSeg->lgfromstart = totLength;
|
||||||
|
|
||||||
if (ext && ind) {
|
if (ext && ind) {
|
||||||
int *mrks = (int*)calloc(ind, sizeof(int));
|
int *mrks = (int*)calloc(ind, sizeof(int));
|
||||||
tSegExt *segExt = (tSegExt*)calloc(1, sizeof(tSegExt));
|
tSegExt *segExt = (tSegExt*)calloc(1, sizeof(tSegExt));
|
||||||
|
|
||||||
memcpy(mrks, mi, ind*sizeof(int));
|
memcpy(mrks, mi, ind*sizeof(int));
|
||||||
segExt->nbMarks = ind;
|
segExt->nbMarks = ind;
|
||||||
segExt->marks = mrks;
|
segExt->marks = mrks;
|
||||||
curSeg->ext = segExt;
|
curSeg->ext = segExt;
|
||||||
ind = 0;
|
ind = 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
switch (type) {
|
switch (type) {
|
||||||
case TR_STR:
|
case TR_STR:
|
||||||
/* straight */
|
/* straight */
|
||||||
curSeg->type = TR_STR;
|
curSeg->type = TR_STR;
|
||||||
curSeg->length = curLength;
|
curSeg->length = curLength;
|
||||||
curSeg->sin = sin(alf); // Precalculate these
|
curSeg->sin = sin(alf); // Precalculate these
|
||||||
curSeg->cos = cos(alf);
|
curSeg->cos = cos(alf);
|
||||||
|
|
||||||
newxr = xr + curLength * cos(alf); /* find end coordinates */
|
newxr = xr + curLength * cos(alf); /* find end coordinates */
|
||||||
newyr = yr + curLength * sin(alf);
|
newyr = yr + curLength * sin(alf);
|
||||||
newxl = xl + curLength * cos(alf);
|
newxl = xl + curLength * cos(alf);
|
||||||
newyl = yl + curLength * sin(alf);
|
newyl = yl + curLength * sin(alf);
|
||||||
|
|
||||||
curSeg->vertex[TR_SR].x = xr;
|
curSeg->vertex[TR_SR].x = xr;
|
||||||
curSeg->vertex[TR_SR].y = yr;
|
curSeg->vertex[TR_SR].y = yr;
|
||||||
curSeg->vertex[TR_SR].z = curzsr;
|
curSeg->vertex[TR_SR].z = curzsr;
|
||||||
|
|
||||||
curSeg->vertex[TR_SL].x = xl;
|
curSeg->vertex[TR_SL].x = xl;
|
||||||
curSeg->vertex[TR_SL].y = yl;
|
curSeg->vertex[TR_SL].y = yl;
|
||||||
curSeg->vertex[TR_SL].z = curzsl;
|
curSeg->vertex[TR_SL].z = curzsl;
|
||||||
|
|
||||||
curSeg->vertex[TR_ER].x = newxr;
|
curSeg->vertex[TR_ER].x = newxr;
|
||||||
curSeg->vertex[TR_ER].y = newyr;
|
curSeg->vertex[TR_ER].y = newyr;
|
||||||
curSeg->vertex[TR_ER].z = curzer;
|
curSeg->vertex[TR_ER].z = curzer;
|
||||||
|
|
||||||
curSeg->vertex[TR_EL].x = newxl;
|
curSeg->vertex[TR_EL].x = newxl;
|
||||||
curSeg->vertex[TR_EL].y = newyl;
|
curSeg->vertex[TR_EL].y = newyl;
|
||||||
curSeg->vertex[TR_EL].z = curzel;
|
curSeg->vertex[TR_EL].z = curzel;
|
||||||
|
|
||||||
curSeg->angle[TR_ZS] = alf;
|
curSeg->angle[TR_ZS] = alf;
|
||||||
curSeg->angle[TR_ZE] = alf;
|
curSeg->angle[TR_ZE] = alf;
|
||||||
curSeg->angle[TR_YR] = atan2(curSeg->vertex[TR_ER].z - curSeg->vertex[TR_SR].z, curLength);
|
curSeg->angle[TR_YR] = atan2(curSeg->vertex[TR_ER].z - curSeg->vertex[TR_SR].z, curLength);
|
||||||
curSeg->angle[TR_YL] = atan2(curSeg->vertex[TR_EL].z - curSeg->vertex[TR_SL].z, curLength);
|
curSeg->angle[TR_YL] = atan2(curSeg->vertex[TR_EL].z - curSeg->vertex[TR_SL].z, curLength);
|
||||||
curSeg->angle[TR_XS] = atan2(curSeg->vertex[TR_SL].z - curSeg->vertex[TR_SR].z, width);
|
curSeg->angle[TR_XS] = atan2(curSeg->vertex[TR_SL].z - curSeg->vertex[TR_SR].z, width);
|
||||||
curSeg->angle[TR_XE] = atan2(curSeg->vertex[TR_EL].z - curSeg->vertex[TR_ER].z, width);
|
curSeg->angle[TR_XE] = atan2(curSeg->vertex[TR_EL].z - curSeg->vertex[TR_ER].z, width);
|
||||||
|
|
||||||
curSeg->Kzl = tan(curSeg->angle[TR_YR]);
|
curSeg->Kzl = tan(curSeg->angle[TR_YR]);
|
||||||
curSeg->Kzw = (curSeg->angle[TR_XE] - curSeg->angle[TR_XS]) / curLength;
|
curSeg->Kzw = (curSeg->angle[TR_XE] - curSeg->angle[TR_XS]) / curLength;
|
||||||
curSeg->Kyl = 0;
|
curSeg->Kyl = 0;
|
||||||
|
|
||||||
curSeg->rgtSideNormal.x = -sin(alf);
|
curSeg->rgtSideNormal.x = -sin(alf);
|
||||||
curSeg->rgtSideNormal.y = cos(alf);
|
curSeg->rgtSideNormal.y = cos(alf);
|
||||||
|
|
||||||
TSTX(newxr); TSTX(newxl);
|
TSTX(newxr); TSTX(newxl);
|
||||||
TSTY(newyr); TSTY(newyl);
|
TSTY(newyr); TSTY(newyl);
|
||||||
|
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case TR_LFT:
|
case TR_LFT:
|
||||||
/* left curve */
|
/* left curve */
|
||||||
curSeg->type = TR_LFT;
|
curSeg->type = TR_LFT;
|
||||||
curSeg->radius = radius;
|
curSeg->radius = radius;
|
||||||
curSeg->radiusr = radius + wi2;
|
curSeg->radiusr = radius + wi2;
|
||||||
curSeg->radiusl = radius - wi2;
|
curSeg->radiusl = radius - wi2;
|
||||||
curSeg->arc = curArc;
|
curSeg->arc = curArc;
|
||||||
curSeg->length = curLength;
|
curSeg->length = curLength;
|
||||||
curSeg->sin = 0.0; //Not used for curves
|
curSeg->sin = 0.0; //Not used for curves
|
||||||
curSeg->cos = 0.0;
|
curSeg->cos = 0.0;
|
||||||
|
|
||||||
innerradius = radius - wi2; /* left side aligned */
|
innerradius = radius - wi2; /* left side aligned */
|
||||||
cenx = xl - innerradius * sin(alf); /* compute center location: */
|
cenx = xl - innerradius * sin(alf); /* compute center location: */
|
||||||
ceny = yl + innerradius * cos(alf);
|
ceny = yl + innerradius * cos(alf);
|
||||||
curSeg->center.x = cenx;
|
curSeg->center.x = cenx;
|
||||||
curSeg->center.y = ceny;
|
curSeg->center.y = ceny;
|
||||||
|
|
||||||
curSeg->angle[TR_ZS] = alf;
|
curSeg->angle[TR_ZS] = alf;
|
||||||
curSeg->angle[TR_CS] = (tdble)(alf - PI / 2.0);
|
curSeg->angle[TR_CS] = (tdble)(alf - PI / 2.0);
|
||||||
alf += curArc;
|
alf += curArc;
|
||||||
curSeg->angle[TR_ZE] = alf;
|
curSeg->angle[TR_ZE] = alf;
|
||||||
|
|
||||||
newxl = cenx + innerradius * sin(alf); /* location of end */
|
newxl = cenx + innerradius * sin(alf); /* location of end */
|
||||||
newyl = ceny - innerradius * cos(alf);
|
newyl = ceny - innerradius * cos(alf);
|
||||||
newxr = cenx + (innerradius + width) * sin(alf); /* location of end */
|
newxr = cenx + (innerradius + width) * sin(alf); /* location of end */
|
||||||
newyr = ceny - (innerradius + width) * cos(alf);
|
newyr = ceny - (innerradius + width) * cos(alf);
|
||||||
|
|
||||||
curSeg->vertex[TR_SR].x = xr;
|
curSeg->vertex[TR_SR].x = xr;
|
||||||
curSeg->vertex[TR_SR].y = yr;
|
curSeg->vertex[TR_SR].y = yr;
|
||||||
curSeg->vertex[TR_SR].z = curzsr;
|
curSeg->vertex[TR_SR].z = curzsr;
|
||||||
|
|
||||||
curSeg->vertex[TR_SL].x = xl;
|
curSeg->vertex[TR_SL].x = xl;
|
||||||
curSeg->vertex[TR_SL].y = yl;
|
curSeg->vertex[TR_SL].y = yl;
|
||||||
curSeg->vertex[TR_SL].z = curzsl;
|
curSeg->vertex[TR_SL].z = curzsl;
|
||||||
|
|
||||||
curSeg->vertex[TR_ER].x = newxr;
|
curSeg->vertex[TR_ER].x = newxr;
|
||||||
curSeg->vertex[TR_ER].y = newyr;
|
curSeg->vertex[TR_ER].y = newyr;
|
||||||
curSeg->vertex[TR_ER].z = curzer;
|
curSeg->vertex[TR_ER].z = curzer;
|
||||||
|
|
||||||
curSeg->vertex[TR_EL].x = newxl;
|
curSeg->vertex[TR_EL].x = newxl;
|
||||||
curSeg->vertex[TR_EL].y = newyl;
|
curSeg->vertex[TR_EL].y = newyl;
|
||||||
curSeg->vertex[TR_EL].z = curzel;
|
curSeg->vertex[TR_EL].z = curzel;
|
||||||
|
|
||||||
curSeg->angle[TR_YR] = atan2(curSeg->vertex[TR_ER].z - curSeg->vertex[TR_SR].z, curArc * (innerradius + width));
|
curSeg->angle[TR_YR] = atan2(curSeg->vertex[TR_ER].z - curSeg->vertex[TR_SR].z, curArc * (innerradius + width));
|
||||||
curSeg->angle[TR_YL] = atan2(curSeg->vertex[TR_EL].z - curSeg->vertex[TR_SL].z, curArc * innerradius);
|
curSeg->angle[TR_YL] = atan2(curSeg->vertex[TR_EL].z - curSeg->vertex[TR_SL].z, curArc * innerradius);
|
||||||
curSeg->angle[TR_XS] = atan2(curSeg->vertex[TR_SL].z - curSeg->vertex[TR_SR].z, width);
|
curSeg->angle[TR_XS] = atan2(curSeg->vertex[TR_SL].z - curSeg->vertex[TR_SR].z, width);
|
||||||
curSeg->angle[TR_XE] = atan2(curSeg->vertex[TR_EL].z - curSeg->vertex[TR_ER].z, width);
|
curSeg->angle[TR_XE] = atan2(curSeg->vertex[TR_EL].z - curSeg->vertex[TR_ER].z, width);
|
||||||
|
|
||||||
curSeg->Kzl = tan(curSeg->angle[TR_YR]) * (innerradius + width);
|
curSeg->Kzl = tan(curSeg->angle[TR_YR]) * (innerradius + width);
|
||||||
curSeg->Kzw = (curSeg->angle[TR_XE] - curSeg->angle[TR_XS]) / curArc;
|
curSeg->Kzw = (curSeg->angle[TR_XE] - curSeg->angle[TR_XS]) / curArc;
|
||||||
curSeg->Kyl = 0;
|
curSeg->Kyl = 0;
|
||||||
|
|
||||||
/* to find the boundary */
|
/* to find the boundary */
|
||||||
al = (tdble)(curArc / 36.0);
|
al = (tdble)(curArc / 36.0);
|
||||||
alfl = curSeg->angle[TR_CS];
|
alfl = curSeg->angle[TR_CS];
|
||||||
|
|
||||||
for (j = 0; j < 36; j++) {
|
for (j = 0; j < 36; j++) {
|
||||||
alfl += al;
|
alfl += al;
|
||||||
x1 = curSeg->center.x + (innerradius) * cos(alfl); /* location of end */
|
x1 = curSeg->center.x + (innerradius) * cos(alfl); /* location of end */
|
||||||
y1 = curSeg->center.y + (innerradius) * sin(alfl);
|
y1 = curSeg->center.y + (innerradius) * sin(alfl);
|
||||||
x2 = curSeg->center.x + (innerradius + width) * cos(alfl); /* location of end */
|
x2 = curSeg->center.x + (innerradius + width) * cos(alfl); /* location of end */
|
||||||
y2 = curSeg->center.y + (innerradius + width) * sin(alfl);
|
y2 = curSeg->center.y + (innerradius + width) * sin(alfl);
|
||||||
TSTX(x1); TSTX(x2);
|
TSTX(x1); TSTX(x2);
|
||||||
TSTY(y1); TSTY(y2);
|
TSTY(y1); TSTY(y2);
|
||||||
}
|
}
|
||||||
|
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case TR_RGT:
|
case TR_RGT:
|
||||||
/* right curve */
|
/* right curve */
|
||||||
curSeg->type = TR_RGT;
|
curSeg->type = TR_RGT;
|
||||||
curSeg->radius = radius;
|
curSeg->radius = radius;
|
||||||
curSeg->radiusr = radius - wi2;
|
curSeg->radiusr = radius - wi2;
|
||||||
curSeg->radiusl = radius + wi2;
|
curSeg->radiusl = radius + wi2;
|
||||||
curSeg->arc = curArc;
|
curSeg->arc = curArc;
|
||||||
curSeg->length = curLength;
|
curSeg->length = curLength;
|
||||||
curSeg->sin = 0.0; //Not used for curves
|
curSeg->sin = 0.0; //Not used for curves
|
||||||
curSeg->cos = 0.0;
|
curSeg->cos = 0.0;
|
||||||
|
|
||||||
innerradius = radius - wi2; /* right side aligned */
|
innerradius = radius - wi2; /* right side aligned */
|
||||||
cenx = xr + innerradius * sin(alf); /* compute center location */
|
cenx = xr + innerradius * sin(alf); /* compute center location */
|
||||||
ceny = yr - innerradius * cos(alf);
|
ceny = yr - innerradius * cos(alf);
|
||||||
curSeg->center.x = cenx;
|
curSeg->center.x = cenx;
|
||||||
curSeg->center.y = ceny;
|
curSeg->center.y = ceny;
|
||||||
|
|
||||||
curSeg->angle[TR_ZS] = alf;
|
curSeg->angle[TR_ZS] = alf;
|
||||||
curSeg->angle[TR_CS] = (tdble)(alf + PI / 2.0);
|
curSeg->angle[TR_CS] = (tdble)(alf + PI / 2.0);
|
||||||
alf -= curSeg->arc;
|
alf -= curSeg->arc;
|
||||||
curSeg->angle[TR_ZE] = alf;
|
curSeg->angle[TR_ZE] = alf;
|
||||||
|
|
||||||
newxl = cenx - (innerradius + width) * sin(alf); /* location of end */
|
newxl = cenx - (innerradius + width) * sin(alf); /* location of end */
|
||||||
newyl = ceny + (innerradius + width) * cos(alf);
|
newyl = ceny + (innerradius + width) * cos(alf);
|
||||||
newxr = cenx - innerradius * sin(alf); /* location of end */
|
newxr = cenx - innerradius * sin(alf); /* location of end */
|
||||||
newyr = ceny + innerradius * cos(alf);
|
newyr = ceny + innerradius * cos(alf);
|
||||||
|
|
||||||
curSeg->vertex[TR_SR].x = xr;
|
curSeg->vertex[TR_SR].x = xr;
|
||||||
curSeg->vertex[TR_SR].y = yr;
|
curSeg->vertex[TR_SR].y = yr;
|
||||||
curSeg->vertex[TR_SR].z = curzsr;
|
curSeg->vertex[TR_SR].z = curzsr;
|
||||||
|
|
||||||
curSeg->vertex[TR_SL].x = xl;
|
curSeg->vertex[TR_SL].x = xl;
|
||||||
curSeg->vertex[TR_SL].y = yl;
|
curSeg->vertex[TR_SL].y = yl;
|
||||||
curSeg->vertex[TR_SL].z = curzsl;
|
curSeg->vertex[TR_SL].z = curzsl;
|
||||||
|
|
||||||
curSeg->vertex[TR_ER].x = newxr;
|
curSeg->vertex[TR_ER].x = newxr;
|
||||||
curSeg->vertex[TR_ER].y = newyr;
|
curSeg->vertex[TR_ER].y = newyr;
|
||||||
curSeg->vertex[TR_ER].z = curzer;
|
curSeg->vertex[TR_ER].z = curzer;
|
||||||
|
|
||||||
curSeg->vertex[TR_EL].x = newxl;
|
curSeg->vertex[TR_EL].x = newxl;
|
||||||
curSeg->vertex[TR_EL].y = newyl;
|
curSeg->vertex[TR_EL].y = newyl;
|
||||||
curSeg->vertex[TR_EL].z = curzel;
|
curSeg->vertex[TR_EL].z = curzel;
|
||||||
|
|
||||||
curSeg->angle[TR_YR] = atan2(curSeg->vertex[TR_ER].z - curSeg->vertex[TR_SR].z, curArc * innerradius);
|
curSeg->angle[TR_YR] = atan2(curSeg->vertex[TR_ER].z - curSeg->vertex[TR_SR].z, curArc * innerradius);
|
||||||
curSeg->angle[TR_YL] = atan2(curSeg->vertex[TR_EL].z - curSeg->vertex[TR_SL].z, curArc * (innerradius + width));
|
curSeg->angle[TR_YL] = atan2(curSeg->vertex[TR_EL].z - curSeg->vertex[TR_SL].z, curArc * (innerradius + width));
|
||||||
curSeg->angle[TR_XS] = atan2(curSeg->vertex[TR_SL].z - curSeg->vertex[TR_SR].z, width);
|
curSeg->angle[TR_XS] = atan2(curSeg->vertex[TR_SL].z - curSeg->vertex[TR_SR].z, width);
|
||||||
curSeg->angle[TR_XE] = atan2(curSeg->vertex[TR_EL].z - curSeg->vertex[TR_ER].z, width);
|
curSeg->angle[TR_XE] = atan2(curSeg->vertex[TR_EL].z - curSeg->vertex[TR_ER].z, width);
|
||||||
|
|
||||||
curSeg->Kzl = tan(curSeg->angle[TR_YR]) * innerradius;
|
curSeg->Kzl = tan(curSeg->angle[TR_YR]) * innerradius;
|
||||||
curSeg->Kzw = (curSeg->angle[TR_XE] - curSeg->angle[TR_XS]) / curArc;
|
curSeg->Kzw = (curSeg->angle[TR_XE] - curSeg->angle[TR_XS]) / curArc;
|
||||||
curSeg->Kyl = 0;
|
curSeg->Kyl = 0;
|
||||||
|
|
||||||
/* to find the boundaries */
|
/* to find the boundaries */
|
||||||
al = (tdble)(curSeg->arc / 36.0);
|
al = (tdble)(curSeg->arc / 36.0);
|
||||||
alfl = curSeg->angle[TR_CS];
|
alfl = curSeg->angle[TR_CS];
|
||||||
|
|
||||||
for (j = 0; j < 36; j++) {
|
for (j = 0; j < 36; j++) {
|
||||||
alfl -= al;
|
alfl -= al;
|
||||||
x1 = curSeg->center.x + (innerradius + width) * cos(alfl); /* location of end */
|
x1 = curSeg->center.x + (innerradius + width) * cos(alfl); /* location of end */
|
||||||
y1 = curSeg->center.y + (innerradius + width) * sin(alfl);
|
y1 = curSeg->center.y + (innerradius + width) * sin(alfl);
|
||||||
x2 = curSeg->center.x + innerradius * cos(alfl); /* location of end */
|
x2 = curSeg->center.x + innerradius * cos(alfl); /* location of end */
|
||||||
y2 = curSeg->center.y + innerradius * sin(alfl);
|
y2 = curSeg->center.y + innerradius * sin(alfl);
|
||||||
TSTX(x1); TSTX(x2);
|
TSTX(x1); TSTX(x2);
|
||||||
TSTY(y1); TSTY(y2);
|
TSTY(y1); TSTY(y2);
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
AddSides(curSeg, TrackHandle, theTrack, curStep, steps);
|
AddSides(curSeg, TrackHandle, theTrack, curStep, steps);
|
||||||
|
|
||||||
totLength += curSeg->length;
|
totLength += curSeg->length;
|
||||||
xr = newxr;
|
xr = newxr;
|
||||||
yr = newyr;
|
yr = newyr;
|
||||||
xl = newxl;
|
xl = newxl;
|
||||||
yl = newyl;
|
yl = newyl;
|
||||||
curindex++;
|
curindex++;
|
||||||
curStep++;
|
curStep++;
|
||||||
if (type != TR_STR) {
|
if (type != TR_STR) {
|
||||||
/* printf("radius = %f arc = %f steps %d, length %f, stepslg %f\n", radius, RAD2DEG(curArc), steps, length, curLength); */
|
/* printf("radius = %f arc = %f steps %d, length %f, stepslg %f\n", radius, RAD2DEG(curArc), steps, length, curLength); */
|
||||||
radius += dradius;
|
radius += dradius;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
} while (GfParmListSeekNext(TrackHandle, path) == 0);
|
} while (GfParmListSeekNext(TrackHandle, path) == 0);
|
||||||
|
|
||||||
if (ext) {
|
if (ext) {
|
||||||
GfHashRelease(segNameHash, NULL);
|
GfHashRelease(segNameHash, NULL);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* printf("\n"); */
|
/* printf("\n"); */
|
||||||
|
|
||||||
|
|
||||||
theTrack->seg = root;
|
theTrack->seg = root;
|
||||||
theTrack->length = totLength;
|
theTrack->length = totLength;
|
||||||
theTrack->nseg = curindex;
|
theTrack->nseg = curindex;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
|
||||||
Loading…
Reference in a new issue