2017-07-01 03:21:03 +00:00
|
|
|
load adc
|
2017-07-09 22:03:00 +00:00
|
|
|
load reslimit
|
2017-07-01 03:21:03 +00:00
|
|
|
load rev
|
|
|
|
|
load fb_switch
|
|
|
|
|
load vel
|
|
|
|
|
load vel
|
|
|
|
|
load vel
|
|
|
|
|
load pid
|
|
|
|
|
load fault
|
|
|
|
|
load hv
|
|
|
|
|
load sim
|
|
|
|
|
load io
|
2018-09-16 16:21:57 +00:00
|
|
|
load iit
|
2017-07-14 03:41:11 +00:00
|
|
|
link conf
|
2018-03-15 23:32:58 +00:00
|
|
|
hv0.rt_prio = 0.9
|
2017-07-01 03:21:03 +00:00
|
|
|
adc0.rt_prio = 1
|
2017-07-09 22:03:00 +00:00
|
|
|
reslimit0.rt_prio = 3
|
2017-07-01 03:21:03 +00:00
|
|
|
rev0.rt_prio = 4
|
|
|
|
|
fb_switch0.rt_prio = 5
|
|
|
|
|
vel0.rt_prio = 6
|
|
|
|
|
vel1.rt_prio = 6
|
|
|
|
|
vel2.rt_prio = 6
|
2017-07-22 23:29:12 +00:00
|
|
|
io0.rt_prio = 7
|
2020-01-16 03:19:49 +00:00
|
|
|
io0.frt_prio = 3
|
2017-07-01 03:21:03 +00:00
|
|
|
pid0.rt_prio = 8
|
|
|
|
|
fault0.rt_prio = 10
|
2018-09-16 16:21:57 +00:00
|
|
|
iit0.rt_prio = 13
|
2017-07-01 03:21:03 +00:00
|
|
|
sim0.rt_prio = 13
|
2017-09-06 00:01:26 +00:00
|
|
|
term0.rt_prio = 16
|
2017-07-01 03:21:03 +00:00
|
|
|
rev0.rev = conf0.cmd_rev
|
2017-10-02 19:13:59 +00:00
|
|
|
fb_switch0.mot_rev = conf0.mot_fb_rev
|
|
|
|
|
fb_switch0.com_rev = conf0.com_fb_rev
|
|
|
|
|
fb_switch0.joint_rev = conf0.joint_fb_rev
|
2017-07-19 18:27:21 +00:00
|
|
|
reslimit0.res = conf0.mot_fb_res
|
2017-07-01 03:21:03 +00:00
|
|
|
vel1.j = conf0.j
|
|
|
|
|
vel2.j = conf0.j
|
2018-09-16 03:54:33 +00:00
|
|
|
pid0.j_mot = conf0.j
|
|
|
|
|
pid0.j_load = conf0.j_load
|
|
|
|
|
pid0.j_lpf = conf0.j_lpf
|
2017-07-01 03:21:03 +00:00
|
|
|
pid0.pos_p = conf0.pos_p
|
|
|
|
|
pid0.vel_p = conf0.vel_p
|
|
|
|
|
pid0.vel_i = conf0.vel_i
|
|
|
|
|
pid0.vel_g = conf0.vel_g
|
|
|
|
|
pid0.acc_g = conf0.acc_g
|
|
|
|
|
pid0.g = conf0.g
|
|
|
|
|
pid0.max_usr_vel = conf0.max_vel
|
|
|
|
|
pid0.max_usr_acc = conf0.max_acc
|
|
|
|
|
pid0.max_usr_torque = conf0.max_force
|
|
|
|
|
fault0.max_sat = conf0.max_sat
|
|
|
|
|
fault0.max_pos_error = conf0.max_pos_error
|
|
|
|
|
fault0.max_vel_error = conf0.max_vel_error
|
|
|
|
|
fault0.max_dc_cur = conf0.max_dc_cur
|
|
|
|
|
fault0.max_ac_cur = conf0.max_ac_cur
|
|
|
|
|
fault0.max_dc_volt = conf0.max_dc_volt
|
2019-06-07 18:19:57 +00:00
|
|
|
fault0.high_dc_volt = conf0.high_dc_volt
|
2017-07-01 03:21:03 +00:00
|
|
|
fault0.min_dc_volt = conf0.min_dc_volt
|
|
|
|
|
fault0.max_hv_temp = conf0.max_hv_temp
|
|
|
|
|
fault0.max_mot_temp = conf0.max_mot_temp
|
|
|
|
|
fault0.high_hv_temp = conf0.high_hv_temp
|
|
|
|
|
fault0.high_mot_temp = conf0.high_mot_temp
|
|
|
|
|
fault0.fan_hv_temp = conf0.fan_hv_temp
|
|
|
|
|
fault0.fan_mot_temp = conf0.fan_mot_temp
|
2018-10-05 17:53:54 +00:00
|
|
|
fault0.ac_cur = hv0.abs_cur
|
2017-07-01 03:21:03 +00:00
|
|
|
hv0.rev = conf0.out_rev
|
|
|
|
|
hv0.r = conf0.r
|
|
|
|
|
hv0.l = conf0.l
|
|
|
|
|
hv0.psi = conf0.psi
|
|
|
|
|
hv0.cur_p = conf0.cur_p
|
|
|
|
|
hv0.cur_i = conf0.cur_i
|
|
|
|
|
hv0.cur_ff = conf0.cur_ff
|
|
|
|
|
hv0.cur_ind = conf0.cur_ind
|
2017-07-02 18:55:08 +00:00
|
|
|
hv0.max_cur = conf0.max_ac_cur
|
2017-07-19 18:27:21 +00:00
|
|
|
reslimit0.pos_in = rev0.out
|
|
|
|
|
fb_switch0.cmd_pos = reslimit0.pos_out
|
2017-07-02 18:55:08 +00:00
|
|
|
fb_switch0.polecount = conf0.polecount
|
2017-10-02 22:30:42 +00:00
|
|
|
fb_switch0.en = fault0.en_fb
|
2017-07-14 03:41:11 +00:00
|
|
|
fb_switch0.mot_polecount = conf0.mot_fb_polecount
|
|
|
|
|
fb_switch0.joint_polecount = conf0.joint_fb_polecount
|
|
|
|
|
fb_switch0.com_polecount = conf0.com_fb_polecount
|
|
|
|
|
fb_switch0.mot_offset = conf0.mot_fb_offset
|
|
|
|
|
fb_switch0.joint_offset = conf0.joint_fb_offset
|
|
|
|
|
fb_switch0.com_offset = conf0.com_fb_offset
|
2018-12-28 22:59:38 +00:00
|
|
|
fb_switch0.phase_time = conf0.phase_time
|
|
|
|
|
fb_switch0.phase_cur = conf0.phase_cur
|
2017-07-19 18:53:33 +00:00
|
|
|
vel0.pos_in = rev0.out
|
2017-10-02 22:30:42 +00:00
|
|
|
vel0.en = fault0.en_fb
|
2017-07-01 03:21:03 +00:00
|
|
|
vel1.pos_in = fb_switch0.vel_fb
|
2017-10-02 22:30:42 +00:00
|
|
|
vel1.en = fault0.en_fb
|
2019-08-14 10:44:55 +00:00
|
|
|
vel1.torque = pid0.torque_cmd
|
2017-07-01 03:21:03 +00:00
|
|
|
vel2.pos_in = fb_switch0.com_fb
|
2017-10-02 22:30:42 +00:00
|
|
|
vel2.en = fault0.en_fb
|
2019-08-14 10:44:55 +00:00
|
|
|
vel2.torque = pid0.torque_cmd
|
2017-07-01 03:21:03 +00:00
|
|
|
pid0.enable = fault0.en_pid
|
2017-07-19 18:53:33 +00:00
|
|
|
pid0.pos_ext_cmd = reslimit0.pos_out
|
2017-07-01 03:21:03 +00:00
|
|
|
pid0.vel_ext_cmd = vel0.vel
|
2017-07-02 18:55:08 +00:00
|
|
|
pid0.pos_fb = fb_switch0.pos_fb
|
2017-07-01 03:21:03 +00:00
|
|
|
pid0.vel_fb = vel1.vel
|
2017-07-19 18:53:33 +00:00
|
|
|
rev0.in_d = vel0.vel
|
2017-07-01 03:21:03 +00:00
|
|
|
fault0.pos_error = pid0.pos_error
|
|
|
|
|
fault0.vel_error = pid0.vel_error
|
|
|
|
|
fault0.sat = pid0.saturated
|
|
|
|
|
fault0.dc_volt = hv0.dc_volt
|
|
|
|
|
fault0.hv_temp = hv0.hv_temp
|
|
|
|
|
fault0.dc_cur = hv0.dc_cur
|
2018-04-06 20:10:57 +00:00
|
|
|
fault0.hv_error = hv0.fault
|
2017-10-02 22:30:42 +00:00
|
|
|
fault0.fb_ready = fb_switch0.state
|
2017-07-01 03:21:03 +00:00
|
|
|
hv0.en = fault0.en_out
|
|
|
|
|
hv0.pos = vel2.pos_out
|
|
|
|
|
hv0.vel = vel2.vel
|
2017-07-02 18:55:08 +00:00
|
|
|
hv0.scale = fault0.scale
|
2017-07-01 03:21:03 +00:00
|
|
|
io0.fan = fault0.hv_fan
|
|
|
|
|
io0.fault = fault0.fault
|
|
|
|
|
io0.state = fault0.state
|
2017-09-06 00:01:26 +00:00
|
|
|
pe0.udc = hv0.dc_volt
|
|
|
|
|
pe0.idc = 0
|
|
|
|
|
pe0.ud = 0
|
|
|
|
|
pe0.uq = 0
|
2019-05-01 20:39:36 +00:00
|
|
|
pe0.id = hv0.id_fb
|
|
|
|
|
pe0.iq = hv0.iq_fb
|
2017-09-06 00:01:26 +00:00
|
|
|
pe0.torque = pid0.torque_cor_cmd
|
|
|
|
|
pe0.vel = vel1.vel
|
|
|
|
|
pe0.r = conf0.r
|
|
|
|
|
pe0.j = conf0.j
|
2018-09-16 16:21:57 +00:00
|
|
|
pe0.cap = 0.00054
|
|
|
|
|
iit0.max_temp = conf0.max_mot_temp
|
|
|
|
|
iit0.high_temp = conf0.high_mot_temp
|
|
|
|
|
iit0.max_cur = conf0.max_ac_cur
|
|
|
|
|
fault0.mot_temp = iit0.temp
|
2019-06-07 18:19:57 +00:00
|
|
|
iit0.cur = hv0.abs_cur
|
