Write unit tests

Develop comprehensive unit tests using pytest for all modules in the library, including sensors, motion control, communication helpers, and robot helpers. Ensure tests cover edge cases and expected behaviors. Integrate these tests into a CI pipeline so they run automatically on pushes and pull requests to maintain code quality.