Fix can address number for right foot inertial
Fix bug and restored timeout check

Fix initialization of data array
Fix initialization of timestamp to have timeout check working fine