Revision 181f2892 devices/DiWheelDrive/userthread.hpp
devices/DiWheelDrive/userthread.hpp | ||
---|---|---|
3 | 3 |
|
4 | 4 |
#include <ch.hpp> |
5 | 5 |
#include <amiroosconf.h> |
6 |
#include <amiro/Color.h> |
|
7 |
// #include "global.hpp" |
|
8 |
|
|
9 |
// Speed when driving towards the docking station |
|
10 |
#define CHARGING_SPEED 5 |
|
11 |
// Thresh to determain how much update steps should pass while alining |
|
12 |
#define MAX_CORRECTION_STEPS 250 |
|
13 |
// Thresh for wheel proxy sensors, when summed values fall below the state changes |
|
14 |
#define PROXY_WHEEL_THRESH 18000 |
|
15 |
// Thresh for how long (update steps) the front sensors are allowed to detect white |
|
16 |
#define WHITE_COUNT_THRESH 120 |
|
17 |
// Rotation around 180 degrees in microradian |
|
18 |
#define ROTATION_180 3141592 |
|
19 |
// Rotation around -20 degrees in microradian |
|
20 |
#define ROTATION_20 -349065 |
|
21 |
#define ROTATION_DURATION 10000 |
|
22 |
|
|
6 | 23 |
|
7 | 24 |
namespace amiro { |
8 | 25 |
|
26 |
|
|
9 | 27 |
class UserThread : public chibios_rt::BaseStaticThread<USER_THREAD_STACK_SIZE> |
10 | 28 |
{ |
11 |
public: |
|
29 |
|
|
30 |
// Messages which can be received and trigger state changes |
|
31 |
public: |
|
32 |
enum msg_content{ |
|
33 |
STOP, |
|
34 |
START, |
|
35 |
EDGE_LEFT, |
|
36 |
EDGE_RIGHT, |
|
37 |
FUZZY, |
|
38 |
DOCK, |
|
39 |
UNDOCK, |
|
40 |
CHARGE |
|
41 |
}; |
|
42 |
|
|
43 |
// States of user thread state machine |
|
44 |
enum states{ |
|
45 |
FOLLOW_LINE, |
|
46 |
RELEASE, |
|
47 |
CHARGING, |
|
48 |
DETECT_STATION, |
|
49 |
CORRECT_POSITIONING, |
|
50 |
REVERSE, |
|
51 |
CHECK_POSITIONING, |
|
52 |
IDLE |
|
53 |
}; |
|
54 |
|
|
55 |
|
|
56 |
|
|
12 | 57 |
explicit UserThread(); |
13 | 58 |
|
14 | 59 |
virtual ~UserThread(); |
15 | 60 |
|
16 | 61 |
virtual msg_t main(); |
62 |
|
|
63 |
private: |
|
64 |
void setRpmSpeed(const int (&rpmSpeed)[2]); |
|
65 |
void lightOneLed(Color color, int idx); |
|
66 |
void lightAllLeds(Color color); |
|
67 |
/** |
|
68 |
* Uses light ring indicate the state of charge. |
|
69 |
*/ |
|
70 |
void showChargingState(); |
|
71 |
void checkForMotion(); |
|
72 |
bool checkPinVoltage(); |
|
73 |
bool checkPinEnabled(); |
|
74 |
|
|
75 |
/** |
|
76 |
* Check if current position changes when the wheel are deactivated. |
|
77 |
* |
|
78 |
* When AMiRo drives towards the loading station, it stops when a specific marker is reached. |
|
79 |
* In order to validate that the AMiRo is correctly positioned in the loading station |
|
80 |
* the wheels are turned off. When the position remains the same the docking procedure |
|
81 |
* was successful (return 1) otherwise a correction is needed (return 0). |
|
82 |
*/ |
|
83 |
int checkDockingSuccess(); |
|
17 | 84 |
}; |
18 | 85 |
|
19 | 86 |
} // end of namespace amiro |
Also available in: Unified diff