Commit 4

Started code to control dual motor driver - Draft