Fixed headMap() (and size()?)

Turned out to be an unchecked case. Simple addition in while loop condition.
Also, a couple extra test cases are provided (commented out) in case we want to get a BpTree that actually works.