|
|
@ -56,6 +56,24 @@ int32_t ZCanBoardModule::module_xxx_reg(int32_t param_id, bool read, int32_t &va |
|
|
|
PROCESS_REG(kreg_sensor_temperature5, readTemperature(5, val), ACTION_NONE); |
|
|
|
PROCESS_REG(kreg_sensor_temperature6, readTemperature(6, val), ACTION_NONE); |
|
|
|
PROCESS_REG(kreg_sensor_temperature7, readTemperature(7, val), ACTION_NONE); |
|
|
|
|
|
|
|
PROCESS_REG(kreg_pwm0_duty, readPwmDuty(0, val), setPwmDuty(0, val)); |
|
|
|
PROCESS_REG(kreg_pwm1_duty, readPwmDuty(1, val), setPwmDuty(1, val)); |
|
|
|
PROCESS_REG(kreg_pwm2_duty, readPwmDuty(2, val), setPwmDuty(2, val)); |
|
|
|
PROCESS_REG(kreg_pwm3_duty, readPwmDuty(2, val), setPwmDuty(2, val)); |
|
|
|
PROCESS_REG(kreg_pwm4_duty, readPwmDuty(2, val), setPwmDuty(2, val)); |
|
|
|
PROCESS_REG(kreg_pwm5_duty, readPwmDuty(2, val), setPwmDuty(2, val)); |
|
|
|
PROCESS_REG(kreg_pwm6_duty, readPwmDuty(2, val), setPwmDuty(2, val)); |
|
|
|
PROCESS_REG(kreg_pwm7_duty, readPwmDuty(2, val), setPwmDuty(2, val)); |
|
|
|
|
|
|
|
PROCESS_REG(kreg_pwm0_freq, readPwmFreq(0, val), setPwmFreq(0, val)); |
|
|
|
PROCESS_REG(kreg_pwm1_freq, readPwmFreq(1, val), setPwmFreq(1, val)); |
|
|
|
PROCESS_REG(kreg_pwm2_freq, readPwmFreq(2, val), setPwmFreq(2, val)); |
|
|
|
PROCESS_REG(kreg_pwm3_freq, readPwmFreq(3, val), setPwmFreq(3, val)); |
|
|
|
PROCESS_REG(kreg_pwm4_freq, readPwmFreq(4, val), setPwmFreq(4, val)); |
|
|
|
PROCESS_REG(kreg_pwm5_freq, readPwmFreq(5, val), setPwmFreq(5, val)); |
|
|
|
PROCESS_REG(kreg_pwm6_freq, readPwmFreq(6, val), setPwmFreq(6, val)); |
|
|
|
|
|
|
|
default: |
|
|
|
return err::kmodule_not_find_config_index; |
|
|
|
break; |
|
|
@ -100,3 +118,45 @@ int32_t ZCanBoardModule::readTemperature(int32_t sensorId, int32_t &temperature_ |
|
|
|
} |
|
|
|
return temperature_sensor[sensorId]->getTemperature(temperature_val); |
|
|
|
} |
|
|
|
|
|
|
|
int32_t ZCanBoardModule::readPwmDuty(int32_t pwmId, int32_t &duty) { |
|
|
|
if (pwmId < 0 || pwmId >= ZARRAY_SIZE(m_cfg.pwmctrl)) { |
|
|
|
return err::kmodule_not_find_config_index; |
|
|
|
} |
|
|
|
if (m_cfg.pwmctrl[pwmId] == nullptr) { |
|
|
|
return err::kmodule_not_find_config_index; |
|
|
|
} |
|
|
|
duty = m_cfg.pwmctrl[pwmId]->get_pwm_duty(); |
|
|
|
return 0; |
|
|
|
} |
|
|
|
int32_t ZCanBoardModule::setPwmDuty(int32_t pwmId, int32_t duty) { |
|
|
|
if (pwmId < 0 || pwmId >= ZARRAY_SIZE(m_cfg.pwmctrl)) { |
|
|
|
return err::kmodule_not_find_config_index; |
|
|
|
} |
|
|
|
if (m_cfg.pwmctrl[pwmId] == nullptr) { |
|
|
|
return err::kmodule_not_find_config_index; |
|
|
|
} |
|
|
|
m_cfg.pwmctrl[pwmId]->set_pwm_duty(duty); |
|
|
|
return 0; |
|
|
|
} |
|
|
|
|
|
|
|
int32_t ZCanBoardModule::readPwmFreq(int32_t pwmId, int32_t &freq) { |
|
|
|
if (pwmId < 0 || pwmId >= ZARRAY_SIZE(m_cfg.pwmctrl)) { |
|
|
|
return err::kmodule_not_find_config_index; |
|
|
|
} |
|
|
|
if (m_cfg.pwmctrl[pwmId] == nullptr) { |
|
|
|
return err::kmodule_not_find_config_index; |
|
|
|
} |
|
|
|
freq = m_cfg.pwmctrl[pwmId]->get_pwm_freq(); |
|
|
|
return 0; |
|
|
|
} |
|
|
|
int32_t ZCanBoardModule::setPwmFreq(int32_t pwmId, int32_t freq) { |
|
|
|
if (pwmId < 0 || pwmId >= ZARRAY_SIZE(m_cfg.pwmctrl)) { |
|
|
|
return err::kmodule_not_find_config_index; |
|
|
|
} |
|
|
|
if (m_cfg.pwmctrl[pwmId] == nullptr) { |
|
|
|
return err::kmodule_not_find_config_index; |
|
|
|
} |
|
|
|
m_cfg.pwmctrl[pwmId]->set_pwm_freq(freq); |
|
|
|
return 0; |
|
|
|
} |