• actPos : control_data_t
• actual : control_error
• desired : control_error
• Edot : control_error
• Eint : control_error
• Enew : control_error
• Eold : control_error
• raw : control_error
• refPos : control_data_t
• u : control_data_t , control_error