Fix current reading and output

[cpr-fer]

• [x] Add controller type to motor member vars
• [x] Save current reading in member variable
• [x] Limit current reading to closed_loop modules (#41)
• [x] Hand the reading to the hw interface
• [x] Test if on both types of modules

[cpr-fer]

Only requires testing before merge