Interfacing with LAPKT-public

* Added simple SConstruct to build binary library with LAPKT code required
  by the demo
Interfacing with LAPKT

* Synced interfaces with latest version of the planning toolkit