Fix register error
Merge pull request #19 from CAPS-Robotics/rewrite

Fix register error