Added a bunch of comments to make the code more readable.
Fixed typo calling H F, and added some description of designing KF for air drag.