amiro-os / devices / DiWheelDrive / linefollow2.cpp @ c76baf23
History | View | Annotate | Download (682 Bytes)
1 | c76baf23 | Georg Alberding | #include "global.hpp" |
---|---|---|---|
2 | #include "linefollow2.hpp" |
||
3 | |||
4 | |||
5 | void LineFollow::printSensorData(){
|
||
6 | chprintf((BaseSequentialStream*) &SD1, "Test!");
|
||
7 | } |
||
8 | |||
9 | void LineFollow::followLine(int vcnl4020Proximity[4], Global *global){ |
||
10 | chprintf((BaseSequentialStream*) &SD1, "Proximity: WL:0x%04X FL:0x%04X FR:0x%04X WR:0x%04X\n",
|
||
11 | vcnl4020Proximity[constants::DiWheelDrive::PROX_WHEEL_LEFT], |
||
12 | vcnl4020Proximity[constants::DiWheelDrive::PROX_FRONT_LEFT], |
||
13 | vcnl4020Proximity[constants::DiWheelDrive::PROX_FRONT_RIGHT], |
||
14 | vcnl4020Proximity[constants::DiWheelDrive::PROX_WHEEL_RIGHT]); |
||
15 | global->motorcontrol.printGains(); |
||
16 | } |