Upload of the C++ Code

This was tweaked slightly for use specifically on Track A as each needed slight tuning for accuracy due to human variations in construction.