Cleaned up code.
Moved argparse to the front and made setpoints configgable.
Mostly worked on model.