Todo List

Class labust::control::DPControl

Split into policies 2D/3D non-holonomic, 2D/3D holonomic, station keep, tracking, PID, backstepping

Class labust::control::HLControl< Controller, Enable, Windup, OutputType, InputType >

Add windup type. Convert into template. EnablePolicy add service, topic option selection.

Class labust::control::LFControl

Add 3D line following support.

Remove dependencies to LFModel class.

Move onNewPoint to service ?

Move enable to service ?

Add external speed/force specification

Class labust::control::VelocityControl

Add separate joystick scaling for all DOFs

Add identification