Added Kdl to manifest
Added feature extraction functions in FoF.py

Committer: Alessandro Farsi <af342@robotics31.(none)>