Ошибку нашел исправил все работает, теперь нужно скрещивать две программы и самое сложное это декодировать посылки головы. Вернее ни чего сложного, но много времени занимает, вот здесь понадобится помощь.
Схемку и печатку девайса нарисую и выложу.