An algorithm for discrete state sequence and trajectory optimization for hybrid systems with partitioned state space | IEEE Conference Publication | IEEE Xplore