for end in (False,True):
ei = nt if end else 0
fi = nt-1 if end else 1
- cp0i = 0 if end else 3
- cp1i = 1 if end else 2
+ cp0i = 3 if end else 0
+ cp1i = 2 if end else 1
e = np.array(cp[cp0i])
ef_dirn = unit_v(cp[cp1i] - cp[cp0i])
ef_len = np.linalg.norm(np.array(fc_input[fi]) - np.array(fc_input[ei]))