A Graph-Based Approach to Generate Energy-Optimal Robot Trajectories in Polygonal Environments