Rebased  #148 (Added pos+vel and pos+vel+acc command interfaces)

It compiles, but I haven't tested it yet.