Implement CEM on simulated dynamic problem

• Call reward function and step from simulated system
• Sampler for the action trajectories
• Validate with finding the best input trajectory and roll out

@hanikevi needs to provide cem.py and simulated Mass system