![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
d
Robot.cpp@0:d4a8d6a32b36, 2017-03-08 (annotated)
- Committer:
- beacon
- Date:
- Wed Mar 08 16:49:14 2017 +0000
- Revision:
- 0:d4a8d6a32b36
l
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
beacon | 0:d4a8d6a32b36 | 1 | #include "Robot.h" |
beacon | 0:d4a8d6a32b36 | 2 | |
beacon | 0:d4a8d6a32b36 | 3 | /* Work in progress -------------------------------------------- */ |
beacon | 0:d4a8d6a32b36 | 4 | |
beacon | 0:d4a8d6a32b36 | 5 | Robot::Robot(PwmOut* left, PwmOut* right, DigitalOut* enableSignal){ |
beacon | 0:d4a8d6a32b36 | 6 | this->powerSignal = enableSignal; |
beacon | 0:d4a8d6a32b36 | 7 | this->left = left; |
beacon | 0:d4a8d6a32b36 | 8 | this->right = right; |
beacon | 0:d4a8d6a32b36 | 9 | |
beacon | 0:d4a8d6a32b36 | 10 | this->left->period(0.00005f); |
beacon | 0:d4a8d6a32b36 | 11 | this->right->period(0.00005f); |
beacon | 0:d4a8d6a32b36 | 12 | } |
beacon | 0:d4a8d6a32b36 | 13 | |
beacon | 0:d4a8d6a32b36 | 14 | /* work in progress ------------------------------------------- */ |
beacon | 0:d4a8d6a32b36 | 15 | void Robot::drive(){ |
beacon | 0:d4a8d6a32b36 | 16 | //pwm determine what direction it goes. |
beacon | 0:d4a8d6a32b36 | 17 | *powerSignal = 1; |
beacon | 0:d4a8d6a32b36 | 18 | *left = 0.5; |
beacon | 0:d4a8d6a32b36 | 19 | *right = 0.5; |
beacon | 0:d4a8d6a32b36 | 20 | } |
beacon | 0:d4a8d6a32b36 | 21 | |
beacon | 0:d4a8d6a32b36 | 22 | //Remember to set |
beacon | 0:d4a8d6a32b36 | 23 | //DigitalOut powerMotor(PB_2) = 1; |
beacon | 0:d4a8d6a32b36 | 24 | //DigitalIn errorMotor(PB_14); |
beacon | 0:d4a8d6a32b36 | 25 | //if (errorMotor){ |
beacon | 0:d4a8d6a32b36 | 26 | //reset |
beacon | 0:d4a8d6a32b36 | 27 | //} |
beacon | 0:d4a8d6a32b36 | 28 | |
beacon | 0:d4a8d6a32b36 | 29 | //Add management for Overpower!! Pin PB_15 |