Groovy devel

Catkinized the package and added the keyboard teleop.