Standard model (again)

Implemented the standard model in the teleop program, because apparently
we forgot to do that.