Serial Monitor comments added to monitor motor activity. Also, logic added to triangle method to prevent kickstart if wave is conitnuing