181,9 → 181,9 |
SIGNAL (TWI_vect) |
//############################################################################ |
{ // 2 3 4 5 6 7 8 9 |
unsigned char test[] = {0,0,'#',0x1F,255,30,99,49,0x00,7,8,9,10}; |
unsigned char test[] = {0,0,'#',0x1F,255,30,99,64,0x00,7,8,9,10}; |
static unsigned char missing_motor,send = 0,crc = 0,read_more = 0; |
|
J4High; |
switch(twi_state++) |
{ |
//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
203,7 → 203,7 |
case 1: |
i2c_write_byte(Motor[motor].SetPoint); |
// if(!(Motor[motor].Version & MOTOR_STATE_NEW_PROTOCOL_MASK) /*|| !Motor[motor].SetPointLowerBits*/) |
if(!(Motor[motor].Version & MOTOR_STATE_NEW_PROTOCOL_MASK) || !Motor[motor].SetPointLowerBits && !TransmitBlConfig) |
if((!(Motor[motor].Version & MOTOR_STATE_NEW_PROTOCOL_MASK) || !Motor[motor].SetPointLowerBits) && !TransmitBlConfig) |
twi_state++; // skip |
break; |
case 2: |
223,7 → 223,6 |
{ |
if(send <= 10) twi_state--; |
} |
|
break; |
case 3: |
motor++; |
353,5 → 352,6 |
break; |
} |
TWCR |= 0x80; |
J4Low; |
} |
|