LARC 2021

Fixing packet bugs when receiving ids off Robots_Count range

When FIRASim received packets with an id out of range, it by default returned the identifier 0 as the robot that would assume the data sent by the command, causing control problems.