Issue: #5

  * Added motor pulse generation, need further tuning though