Embedded Motion Control 2017 Group 3 / Initial Design
This page is part of the Embedded Motion Control Group 3 of 2017.
The initial design document File:Emc-design-specification.pdf briefly indicates the approach taken towards the problem of solving the maze by the PICO robot, the algorithm used and the system design.
The slides for the initial design presentation can be found here: File:Group3 2017 Initial design presentation.pdf
There are 2 main goals for the PICO robot.
- Corridor competition: To navigate through a corridor and take the first exit without colliding with the walls.
- Maze competition: To solve an unknown maze within given time limit (5 min) which has door and exit it without touching any walls.
The overall Inital design of the project is mentioned in the following section:
The following requirements are listed for the robot (PICO) to complete maze successfully:
- PICO may not touch the walls or any other obstacle in the maze at any time
- PICO must operate fully autonomous (i.e. without input from the team)
- PICO may not be idle for more than 3 seconds from the start of program unless it has passed the exit
- PICO must be able to detect available space using the Laser Range Finder (LRF) and move to the detected space according to the motion planning algorithm
- PICO must be able to find the exit in finite time (≤ 7 sec for maze and ≤ 5 sec for corridor.)
- PICO must be able to detect the objects (dead ends) that have a high probability of being a door
- PICO must be able to open the door in the maze and pass through it
The functions are separate modules called supervisors where, the supervisor unknown of what is inside the other supervisor. This approach makes software architecture simpler, it is also easier to edit and error count will be less since no direct interaction of modules. Supervisors are listed below:
- Path-finding Supervisor
- Door Handling Supervisor
- Wall / Path Detection
- Motion Supervisor
- Actuator Supervisor
1-Pledge Algorithm: Takes in the extracted wall information as input and sets a movement goal for the PICO and move towards it. This algorithm is useful when the robot is challenged to solve loop inside the maze. The algorithm functions as a continuous loop. (Maze challenge)
2- Cornering: Take the corner using the wall information as input. (Corridor challenge)
1-Ring Bell: Ring the bell if it detect the door possible deadends
2-Standstill: Wait for 5 sec to for the door openingsequence.
Wall / Path Detection
1-Read LRF data: Gets raw data from the LRF sensor
2-Filter LRF data: Reduces noise from raw LRF data and splits it into 3 directions (left, right and front).
3-Transform data: Calculate one distance approximation for the 3 directions.
4-Possiblity checker: Calculate for all directions if movement in that direction is possible, taking a ‘safe’ zone around PICO into account.
1-Position stabilizing: Feedback loop that keep PICO approximately in the center of the corridor by implementing a feedback controller for the distance to the walls on the left and right of the robot.
2-Turn Corner: Make a 90 degree turn either on left or on right
1-Steady PICO: Keep the front of the PICO aligned to the direction of movement.
2-Omniwheels handeling: Set speed and angle of Omniwheels
The interfaces are defined as the movement/flow of data between the functions that are defined in above section. The different interfaces are described below.
1- Sending information about current state, which is the distance to walls at -90 degrees, 0 degrees and 90 degrees from the center point and whether it has potential from moving forward and turning left or right. <Struct with float values and booleans>.
2- Forward information about potential movement.<Struct of Boolean>.
3- Forward information about wall distances.<Struct of floats>.
4- Turning command, which is either 1 (turning left) or 2(turning right). <integer>.
5- Send information about the possibility of a door.<Boolean>.
6- Confirmation that door handling is finished <Boolean>.
7- Setting the values for actuator.<Struct of floats>
1- Sensors: Laser Range Finder (LRF), Odometry (Wheel Encoder).
2- Holonomic base (omni-wheels): Maximum translational speed of 0.5 m/s , Max angular speed of 1.2 rad/s.
3- Embedded platform Computer with Ubuntu 14.04 on an Intel i7 (other specifications are unknown)
4- Bell: To produce sound from PICO so as to open the door.