Commit 3c7cfdd2 authored by Sergi Hernandez's avatar Sergi Hernandez
Browse files

Solved a problem in the computation of the slopes.

parent 4ff0e7fa
......@@ -37,8 +37,8 @@ void manager_send_motion_command(void)
if(manager_servos[i].enabled && manager_servos[i].model!=0x0000)
{
servo_ids[num]=manager_servos[i].id;
manager_servos[i].cw_comp=(1<<manager_current_slopes[i]);
manager_servos[i].ccw_comp=(1<<manager_current_slopes[i]);
manager_servos[i].cw_comp=(1<<(manager_current_slopes[i]&0x0F));
manager_servos[i].ccw_comp=(1<<((manager_current_slopes[i]&0xF0)>>4));
write_data[num].data_addr=(uint8_t *)&(manager_servos[i].cw_comp);
num++;
}
......
Supports Markdown
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment