Reorganize code, add basic voltage manipulation, fix errors Reorganize code, add basic voltage manipulation, fix errors