Initial commit

added main
added motor logic