After getting the #T_H_S assembled I've Finally turned a corner with the firmware and got it working the way I want it too. As usual this has taken me longer then I thought and lead me though some code lessons so not all is lost. I hope to start documenting the build process and shooting a video soon. Keep your eyes peeled for future updates