Headers added. First approach to stabilization.

A header has been added to all the source files.

stabilize.py should be further upgraded taking in
account the dynamic model in more detail.