Revert "Added casts to the write calls"
Merge branch 'master' into revert-47-vrbahl
Merge pull request #52 from CMU-Robotics-Club/revert-47-vrbahl

Revert "Added casts to the write calls"