Added test mode to the Baxter ADL with BCI control.
Also added the transformation matrix for the Kinect

Signed-off-by: Andoni Aguirrezabal <aaguirrezabal@live.com>