The goal of the project is to solve an engineering problem motivated by intelligent robotics and to present the solution in a formally correct written form.
The robot is equipped with a proximity sensor, which allows to detect whether the end effector the robot is near some obstacle. The sensor work as follows. In each position of the robot, it is possible to ask if a change in the robot pose by one single step of one step engine will result in collision with some obstacle. In other word, the sensor detects presence of obstacles in a unit distance from the robot's end effector in L1 metric in three dimensional space of the robot joint angles space.
The robot is placed in a scene at a known position with respect to the working area, in which are placed landmarks, defining the coordinate system of the scene, see Figure 2. The basis (x,y,z), which is depicted in Figure 2 is the same as the basis of the scene.
The scene is observed by an unknown perspective camera, located at an unknown fixed position. The camera observes the whole working area, therefore, all landmarks are visible in each image from the camera (landmark positions can be detected by hand).
The end effector of the robot is positioned in a known initial position denoted by the letter A. This position is given in a Cartesian coordinates of the robot. An object is placed at a position denoted by B, which is not known but which is observed by the camera. This object should be moved to the position A. For simplicity, we assume that the object has a form of a single material point, which can be grasped by the robot just by placing the end effector into the point B. While the robot is immaterial and can pass through the obstacles, the point cannot.
An obstacle can be placed into the scene between the image acquisition and movement of the robot. The information about the obstacle in some point in the scene can solely be acquired by placing the end effector close enough so that it can be detected by the proximity sensor.
Solve the problem in a general way, for any shape of the obstacle. Information about the shape of the obstacle in your concrete task will allow you to simulate the solution so that you can present your approach in an experiment. You are not allowed to use the knowledge of the shape of the obstacle in the planning of the trajectory. The robot can detect the obstacle only by ``touching'' it using the proximity sensor.
Scene definition is given in files scb??.txt. The scene is composed of four blocks. The top surface of the first block defines the working area, on which are placed the landmarks and the obstacle defined by the remaining three blocks. The blocks are determined by eight vertices. Each vertex coordinates x y z corresponds to one line in the file. First eight lines in the file define vertices of the first block, the second eight lines the vertices of the second block and so on. The interiors of the block are impenetrable for the object to be transfered.
Image of the working area from the perspective camera is contained in files lrpp??.bmp. The points A and B are shown in the image together with the landmarks with known position in the scene.