|
|
@@ -60,6 +60,17 @@ void can_report_dq_current(u8 can) {
|
|
|
can_send_message(get_indicator_can_id(can), data, sizeof(data), 0);
|
|
|
}
|
|
|
|
|
|
+void can_report_dq_voltage(u8 can) {
|
|
|
+ u8 data[6];
|
|
|
+ encoder_can_key(data, CMD_2_CAN_KEY(Foc_Report_Dq_Vol));
|
|
|
+ float id = foc()->out.vol_dq.d;
|
|
|
+ float iq = foc()->out.vol_dq.q;
|
|
|
+ encode_s16(data + 2, S16Q5(id));
|
|
|
+ encode_s16(data + 4, S16Q5(iq));
|
|
|
+ can_send_message(get_indicator_can_id(can), data, sizeof(data), 0);
|
|
|
+}
|
|
|
+
|
|
|
+
|
|
|
void can_response_hall_offset(u8 can, int offset) {
|
|
|
u8 data[7];
|
|
|
encoder_can_key(data, CMD_2_CAN_KEY(Foc_Cali_Hall_Offset));
|