Polynomial mechanics and optimal control