adding script for the double pendulum contact model and begining of a new control model for the stabilization