work on IMUs and F/T sensor

Finish code for initialization of ports and connections for reading IMUs
and F/T sensors