足立 快仁
/
sikenyou
program_of_Monday
main.cpp
- Committer:
- kaipon
- Date:
- 2021-11-18
- Revision:
- 0:2da7c2bc2ed5
File content as of revision 0:2da7c2bc2ed5:
#include "mbed.h" PwmOut pinAFin(D10); PwmOut pinARin(A1); PwmOut pinBFin(D11); PwmOut pinBRin(D12); void driveMotor(int speedA,int speedB) { float outputA = abs(speedA); float outputB = abs(speedB); if (speedA > 0) { pinAFin=outputA; pinARin=0; } else if (speedA < 0) { pinAFin=0; pinARin=outputA; } else { pinAFin=0; pinARin=0; } if (speedB > 0) { pinBFin=outputB; pinBRin=0; } else if (speedB < 0) { pinBFin=0; pinBRin=outputB; } else { pinBFin=0; pinBRin=0; } } int main() { wait(10); driveMotor(1,1); wait(10); driveMotor(0,0); return 0; }