117 |
|
|
118 |
|
for(i = 0; i < 3*nAdded; i++) { |
119 |
|
j = i + 3*nElements; |
120 |
< |
new_pos[j] = pos[i]; |
121 |
< |
new_vel[j] = vel[i]; |
122 |
< |
new_frc[j] = frc[i]; |
123 |
< |
new_trq[j] = trq[i]; |
124 |
< |
new_ul[j] = ul[i]; |
120 |
> |
new_pos[j] = Apos[i]; |
121 |
> |
new_vel[j] = Avel[i]; |
122 |
> |
new_frc[j] = Afrc[i]; |
123 |
> |
new_trq[j] = Atrq[i]; |
124 |
> |
new_ul[j] = Aul[i]; |
125 |
|
} |
126 |
|
|
127 |
|
for (i = 0; i < 9*nElements; i++) { |
130 |
|
|
131 |
|
for(i = 0; i < 9*nAdded; i++) { |
132 |
|
j = i + 9*nElements; |
133 |
< |
new_Amat[j] = Amat[i]; |
133 |
> |
new_Amat[j] = AAmat[i]; |
134 |
|
} |
135 |
|
|
136 |
|
for (i = 0; i < nElements; i++) { |
139 |
|
|
140 |
|
for(i = 0; i < nAdded; i++) { |
141 |
|
j = i + nElements; |
142 |
< |
new_mu[j] = mu[i]; |
142 |
> |
new_mu[j] = Amu[i]; |
143 |
|
} |
144 |
|
|
145 |
|
delete[] pos; |