Added robot physical constraints
Fixed other bugs with piecewise antenna derivation