Control con bluetooth

Buen día, estoy trabajando en un pequeño proyecto que consiste en un robot que tenga 2 modos de funcionamiento, manual, por medio de un control(móvil android con "bluetooth ssp pro") bluetooth y un modo automático que detecte obstáculos por medio de sensores de ultrasonido. El problema es que no logro cambiar el modo mediante un comando por bluetooth, el modo manual funciona bien por si solo pero al momento de intentar cambiar de modo dejan de funcionar ambos. soy nuevo en arduino y seria genial que me ayudaran o me dieran algún consejo, gracias de antemano.

Robot.ino (2.48 KB)