Main new code

new code for the main
Shoot ready for testing part 2

ready for testing
Main now for shoot

commented out drive