An Introduction to Mathematical Optimal Control Theory