Sec7a Rewrite - Stub Correction

Added initial code for Stub Correction for L0 only; necessary for
Stub-to-Stub Transitions, both STS-WTs and STS-HTs, and for general
neatness
L1-L4 will be added later
NOTE: If any of code is deemed unnecessary (and probably some of it is),
feel free to comment it out.