energy_shaping_lqr