Working on drive source
Merge branch 'master' into drive

Conflicts:
	mechanical_sys/drive/DriveSys.hpp
WindRiver is introducing bugs each compile...
Fixed problems seen in WindRiver
get_inst returns a reference instead of a pointer