void inline motors_pwm() { if (!pwm_cnt) { if (speed1) drv1_turn_on(); if (speed2) drv2_turn_on(); } if (pwm_cnt == speed1) drv1_turn_off(); if (pwm_cnt == speed2) drv2_turn_off(); pwm_cnt++; if (pwm_cnt > PWM_CNT_MAX) pwm_cnt = 0; }
void inline motors_pwm() { if (!m_pwm_cnt) { if (m_speed1) drv1_turn_on(); if (m_speed2) drv2_turn_on(); } if (m_pwm_cnt == m_speed1) drv1_turn_off(); if (m_pwm_cnt == m_speed2) drv2_turn_off(); m_pwm_cnt++; if (m_pwm_cnt > PWM_CNT_MAX) m_pwm_cnt = 0; }