Move Encoder and Odometry from robot to xpcc to reuse in seascon 2015.

Now Encoder and Odometry are template based.