Added draw Two code
Finished HAL utitility functions
Most code is in place for HAL to work, need to add knock state handling code, but we need the-hobbes counter code for that first.
Almost ready for the AI to be tested, just need to instantiate an instance in initEncode