Temporarly implemented the dynamics

Dyanmics is based xdot.