ak1976, насчет адресов
// Head Unid ID
#define HU_ID_1 0x01
#define HU_ID_2 0x40
двухбайтная кодировка, адрес = 140?

а как узнать какой у меня адрес головы? залить тупо прошивку с каким-нибудь адресом, например, твою, и мониторить? или большая вероятность, что адрес так и будет 140?