fix: save and load
This commit is contained in:
		
							parent
							
								
									7460b74c15
								
							
						
					
					
						commit
						fef7e1387b
					
				
							
								
								
									
										76
									
								
								src/main.rs
									
									
									
									
									
								
							
							
						
						
									
										76
									
								
								src/main.rs
									
									
									
									
									
								
							| @ -87,46 +87,36 @@ fn run_all() -> Result<(), Box<dyn std::error::Error>> { | ||||
|     )?; | ||||
| 
 | ||||
|     while running.load(Ordering::SeqCst) { | ||||
|         //let _t = _framerate_handler.handle_time()?;
 | ||||
|         /////////////////
 | ||||
|         let key = highgui::wait_key(1)?; | ||||
|         let key = highgui::wait_key(20)?; | ||||
|         let v = qualibration.draw_sequence(); | ||||
| 
 | ||||
|         if key != -1 { | ||||
|             println!("key: {key}"); | ||||
|             // 81 <-  -> 83 
 | ||||
|         } | ||||
|         qualibration.param.key = key; | ||||
|         if key == 27 { | ||||
|             break; | ||||
|         } | ||||
| 
 | ||||
|         let v = qualibration.draw_sequence(); | ||||
|         if v.is_some() { | ||||
|             if qualibration.param.capture_mode { | ||||
|                 let pl: Vec<(f32, f32, u32)> = v | ||||
|                     .unwrap() | ||||
|                     .iter() | ||||
|                     .map(|pt| (pt.x, pt.y, u32::from(pt.color))) | ||||
|                     .collect(); | ||||
| 
 | ||||
|                 let _ = con.set( | ||||
|                     format!("/pl/{}/{}", config.client_id, config.laser_id), | ||||
|                     format!("{:?}", pl), | ||||
|                 )?; | ||||
|                 qualibration.param.save_image()?; | ||||
|             } | ||||
| 
 | ||||
|             qualibration.run_step()?; | ||||
|             break; | ||||
|         } else if v.is_none() { | ||||
|             continue; | ||||
|         } | ||||
|         //qualibration.id = next_id;
 | ||||
| 
 | ||||
|         //let q_id = qualibration.id.clone();
 | ||||
|         //let mut n = 65534;
 | ||||
|         //if let Sequence::TakeMultiple(m) = q_id.clone().unwrap_or(Sequence::Finish) {
 | ||||
|         //    n = m;
 | ||||
|         //};
 | ||||
|         //if qualibration.capture_mode
 | ||||
|         //    && (q_id != Some(Sequence::WaitSpace)
 | ||||
|         //        || q_id != Some(Sequence::PlayLineDotted)
 | ||||
|         //        || n != 65534)
 | ||||
|         //{
 | ||||
|         //    let millis = std::time::Duration::from_millis(400); // TODO: find solution to know when change has been done
 | ||||
|         //    std::thread::sleep(millis);
 | ||||
|         //}
 | ||||
|         if qualibration.param.capture_mode { | ||||
|             let pl: Vec<(f32, f32, u32)> = v | ||||
|                 .unwrap() | ||||
|                 .iter() | ||||
|                 .map(|pt| (pt.x, pt.y, u32::from(pt.color))) | ||||
|                 .collect(); | ||||
|             con.set( | ||||
|                 format!("/pl/{}/{}", config.client_id, config.laser_id), | ||||
|                 format!("{:?}", pl), | ||||
|             )?; | ||||
|         } | ||||
| 
 | ||||
|         qualibration.run_step()?; | ||||
|     } | ||||
| 
 | ||||
|     let _ = con.set( | ||||
| @ -135,3 +125,21 @@ fn run_all() -> Result<(), Box<dyn std::error::Error>> { | ||||
|     )?; | ||||
|     Ok(()) | ||||
| } | ||||
| 
 | ||||
| //let _t = _framerate_handler.handle_time()?;
 | ||||
| /////////////////
 | ||||
| //qualibration.id = next_id;
 | ||||
| 
 | ||||
| //let q_id = qualibration.id.clone();
 | ||||
| //let mut n = 65534;
 | ||||
| //if let Sequence::TakeMultiple(m) = q_id.clone().unwrap_or(Sequence::Finish) {
 | ||||
| //    n = m;
 | ||||
| //};
 | ||||
| //if qualibration.capture_mode
 | ||||
| //    && (q_id != Some(Sequence::WaitSpace)
 | ||||
| //        || q_id != Some(Sequence::PlayLineDotted)
 | ||||
| //        || n != 65534)
 | ||||
| //{
 | ||||
| //    let millis = std::time::Duration::from_millis(400); // TODO: find solution to know when change has been done
 | ||||
| //    std::thread::sleep(millis);
 | ||||
| //}
 | ||||
|  | ||||
| @ -37,7 +37,7 @@ pub struct Qualibration { | ||||
| } | ||||
| 
 | ||||
| impl Qualibration { | ||||
|     pub fn new() -> Result<Self> { | ||||
|     pub fn new() -> Result<Self, Box<dyn std::error::Error>> { | ||||
|         //let v: Vec<Box<dyn Sequence>> = vec![];
 | ||||
| 
 | ||||
|         let mut dir_name = "".to_string(); //"building.jpg".to_string(); // by default
 | ||||
| @ -54,23 +54,25 @@ impl Qualibration { | ||||
|         let mut frame = Mat::default(); | ||||
|         cam.read(&mut frame)?; | ||||
| 
 | ||||
|         // 38400 -> r:150, v:0, b:0
 | ||||
|         let beg = Point::from((0., 0., 38400)); | ||||
|         let beg2 = Point::from((4095., 0., 38400)); | ||||
|         let end = Point::from((4095., 4095., 38400)); | ||||
|         // 9830400 -> r:150, v:0, b:0
 | ||||
|         let beg = Point::from((0., 0., 9830400)); | ||||
|         let beg2 = Point::from((0., 4095., 9830400)); | ||||
|         let end = Point::from((4095., 4095., 9830400)); | ||||
|         let seq: Vec<Box<dyn Sequence>> = vec![ | ||||
|             Box::new(LoadImage::new()), | ||||
|             Box::new(WaitSpace::new(beg, end)), | ||||
|             Box::new(InitBorder::new(beg, end)), | ||||
|             Box::new(LineDotted::new(beg, end, true, false)), | ||||
|             Box::new(InitIdcode::new(beg2, end)), | ||||
|             Box::new(SaveImage::new()), | ||||
|             Box::new(WaitSpace::new(beg, end, 400)), | ||||
|             Box::new(InitBorder::new(beg, end, 400)), | ||||
|             Box::new(LineDotted::new(beg, end, 2, true, false, 400)), | ||||
|             Box::new(InitIdcode::new(beg2, end, 400)), | ||||
|         ]; | ||||
|         //let now = std::time::Instant::now();
 | ||||
|         let seq_names = get_sequence_name(&seq); | ||||
|         let mut param = Param::new(dir_name.to_owned(), seq_names)?; | ||||
|         if !param.capture_mode { | ||||
|             param.load_image()?; | ||||
|         } | ||||
|         Ok(Qualibration { | ||||
|             seq, | ||||
|             cam, | ||||
|             param: Param::new(dir_name.to_owned())?, | ||||
|             param, | ||||
|         }) | ||||
|     } | ||||
| 
 | ||||
| @ -92,7 +94,18 @@ impl Qualibration { | ||||
|     } | ||||
| 
 | ||||
|     pub fn run_step(self: &mut Self) -> Result<(), Box<dyn std::error::Error>> { | ||||
|         let seq_id = self.param.seq_id; | ||||
|         let seq_name = self.seq[seq_id].sequence_name(); | ||||
|         println!("seq[{seq_id}]: {seq_name}"); | ||||
| 
 | ||||
|         if self.param.capture_mode { | ||||
|             let millis_nb = self.seq[self.param.seq_id].wait_milis(); | ||||
|             let millis = std::time::Duration::from_millis(millis_nb); // TODO: find solution to know when change has been done
 | ||||
|             std::thread::sleep(millis); | ||||
|         } | ||||
|  
 | ||||
|         let mut frame = Mat::default(); | ||||
|         //println!("sequence: {}:{:?}", self.param.seq_id, &self.seq[self.param.seq_id]);
 | ||||
|         if self.param.capture_mode { | ||||
|             self.cam.read(&mut frame)?; | ||||
|             highgui::imshow("camera", &frame)?; | ||||
| @ -108,4 +121,16 @@ impl Qualibration { | ||||
| 
 | ||||
|         Ok(()) | ||||
|     } | ||||
| 
 | ||||
| } | ||||
| 
 | ||||
| pub fn get_sequence_name(seq: &Vec<Box<dyn Sequence>>) -> Vec<String> { | ||||
|     let mut v = vec![]; | ||||
| 
 | ||||
|     for i in 0..seq.len() { | ||||
|         v.push(seq[i].sequence_name()); | ||||
|     } | ||||
| 
 | ||||
|     v | ||||
| } | ||||
| 
 | ||||
|  | ||||
| @ -819,6 +819,7 @@ pub fn trackbar_init_param(mem: &mut Param, winname: &str) -> Result<()> { | ||||
| 
 | ||||
|     create_trackbar("nb_all", winname, Some(&mut mem.nb_all), 400, None)?; | ||||
|     create_trackbar("nb_visible", winname, Some(&mut mem.nb_visible), 400, None)?; | ||||
|     create_trackbar("nb_wait", winname, Some(&mut mem.nb_wait), 40, None)?; | ||||
|     create_trackbar("r", winname, Some(&mut mem.r), MAX_TRACKBAR, None)?; | ||||
|     create_trackbar("g", winname, Some(&mut mem.g), MAX_TRACKBAR, None)?; | ||||
|     create_trackbar("b", winname, Some(&mut mem.b), MAX_TRACKBAR, None)?; | ||||
| @ -914,7 +915,7 @@ pub fn line_pos(mem: &mut Param, winname: &str) -> Result<()> { | ||||
| pub fn adding_trackbar(mem: &mut Param, _winname: &str) -> Result<()> { | ||||
|     //println!("winname: {winname}");
 | ||||
|     //line_pos(&mut mem, "Play Line")?;
 | ||||
|     //trackbar_init_param(mem, "init_param")?;
 | ||||
|     trackbar_init_param(mem, "init_param")?; | ||||
| 
 | ||||
|     named_window("histo bgr", WINDOW_AUTOSIZE)?; | ||||
|     associate_trackbar("histo bgr", &mut mem.tresh)?; | ||||
|  | ||||
| @ -10,6 +10,7 @@ use std::time::Instant; | ||||
| #[derive(Clone, Debug)] | ||||
| pub struct Param { | ||||
|     pub seq_id: usize, | ||||
|     pub seq_names: Vec<String>, | ||||
|     pub imgs: Vec<Vec<Mat>>, | ||||
|     pub dst_size: i32, | ||||
|     pub r: i32, | ||||
| @ -35,7 +36,7 @@ pub struct Param { | ||||
| } | ||||
| 
 | ||||
| impl Param { | ||||
|     pub fn new(dir_name: String) -> Result<Self> { | ||||
|     pub fn new(dir_name: String, seq_names: Vec<String>) -> Result<Self> { | ||||
|         Ok(Self { | ||||
|             begin: std::time::Instant::now(), | ||||
|             capture_mode: dir_name.len() == 0, | ||||
| @ -43,6 +44,7 @@ impl Param { | ||||
|             key: -1, | ||||
|             imgs: vec![vec![]], | ||||
|             seq_id: 0, | ||||
|             seq_names, | ||||
|             dst_size: 900, | ||||
|             r: 150, | ||||
|             g: 0, | ||||
| @ -50,7 +52,7 @@ impl Param { | ||||
|             nb_all: 120, | ||||
|             nb_visible: 40, | ||||
|             nb_liss: 10, | ||||
|             nb_wait: 30, | ||||
|             nb_wait: 3, | ||||
|             tresh: Treshold::new("histogram", 160, 255)?, | ||||
|             canny_v1: 170, | ||||
|             canny_v2: 255, | ||||
| @ -80,11 +82,11 @@ impl Param { | ||||
|         ); | ||||
|         create_dir(&new_dir).unwrap_or(()); | ||||
|         for (i, img_seq) in self.imgs.iter().enumerate() { | ||||
|             let seq_dir_name = format!("{new_dir}/{i}"); | ||||
|             let seq_dir_name = format!("{new_dir}/seq_{i}_{}", self.seq_names[i]); | ||||
|             create_dir(&seq_dir_name).unwrap_or(()); | ||||
|             for img in img_seq { | ||||
|             for (id, img) in img_seq.iter().enumerate() { | ||||
|                 let mut name_img = format!("{seq_dir_name}/"); | ||||
|                 name_img.push_str(&format!("img_{i}.png")); | ||||
|                 name_img.push_str(&format!("img_{id}.png")); | ||||
|                 imwrite(&name_img, img, &Vector::from_slice(&[6, 6, 6, 0]))?; | ||||
|             } | ||||
|         } | ||||
| @ -100,11 +102,16 @@ impl Param { | ||||
|             let dir = entry?; | ||||
|             let path = dir.path(); // sequence directory
 | ||||
|             let names: Vec<&str> = path.to_str().unwrap().split("/").collect(); | ||||
|             let seq_id: usize = names[names.len() - 1].parse()?; | ||||
|             let parts: Vec<&str> = names[names.len() - 1].split("_").collect(); | ||||
|             let nbr = parts[1]; | ||||
|             //println!("\t\t=> '{}'",  names[names.len() - 1]);
 | ||||
|             let seq_id: usize = parts[1].parse()?; | ||||
|             for entry in read_dir(&path)? { | ||||
|                 let sub_path = entry?.path(); | ||||
|                 let names: Vec<&str> = path.to_str().unwrap().split("/").collect(); | ||||
|                 let names: Vec<&str> = sub_path.to_str().unwrap().split("/").collect(); | ||||
|                 let img_name = names[names.len() - 1]; | ||||
|                 //println!("all_names: {:?}", &names);
 | ||||
|                 //println!("img_name: {}", img_name);
 | ||||
|                 let img_id: usize = img_name[4..img_name.len() - 4].parse()?; | ||||
|                 let img: Mat = imread( | ||||
|                     &find_file(&sub_path.to_str().unwrap(), false, false)?, | ||||
|  | ||||
| @ -18,6 +18,8 @@ pub trait Sequence { | ||||
|     fn draw(&self, mem: &Param) -> Option<Vec<Point>>; | ||||
|     fn compute_sequence(&mut self, mem: &mut Param) -> Result<(), Box<dyn std::error::Error>>; | ||||
|     fn is_capture(&self) -> bool; | ||||
|     fn sequence_name(&self) -> String; | ||||
|     fn wait_milis(&self) -> u64; | ||||
| } | ||||
| 
 | ||||
| impl std::fmt::Debug for dyn Sequence { | ||||
|  | ||||
| @ -7,14 +7,15 @@ use crate::qualibration::{ | ||||
| 
 | ||||
| use crate::qualibration::annalyse::image_diff; | ||||
| use crate::qualibration::borders::{ | ||||
|     bord_mult, get_extermities, get_intersection, probabilistic_hough, | ||||
|     bord_mult, get_extermities, get_intersection, probabilistic_hough, mix_borders, | ||||
| }; | ||||
| 
 | ||||
| use opencv::{ | ||||
|     calib3d, | ||||
|     core::{Mat, Point as OcvPoint, Size, VecN, Vector}, | ||||
|     imgproc::{canny, cvt_color, COLOR_BGR2GRAY}, | ||||
|     core::{Mat, Point as OcvPoint, Size, VecN, Vector, Scalar, BORDER_CONSTANT}, | ||||
|     imgproc::{self, canny, cvt_color, COLOR_BGR2GRAY, line}, | ||||
|     Result, | ||||
|     highgui, | ||||
| }; | ||||
| 
 | ||||
| opencv::opencv_branch_4! { | ||||
| @ -30,10 +31,11 @@ pub struct InitBorder { | ||||
|     finished: bool, | ||||
|     cnt: usize, | ||||
|     borders: [Point; 4], | ||||
|     nb_millis: u64, | ||||
| } | ||||
| 
 | ||||
| impl InitBorder { | ||||
|     pub fn new(beg: Point, end: Point) -> Self { | ||||
|     pub fn new(beg: Point, end: Point, nb_millis: u64) -> Self { | ||||
|         InitBorder { | ||||
|             borders: [ | ||||
|                 Point { | ||||
| @ -57,6 +59,7 @@ impl InitBorder { | ||||
|                     color: end.color, | ||||
|                 }, | ||||
|             ], | ||||
|             nb_millis, | ||||
|             cnt: 0, | ||||
|             finished: false, | ||||
|         } | ||||
| @ -67,7 +70,7 @@ impl Sequence for InitBorder { | ||||
|     //type Obj = Self;
 | ||||
| 
 | ||||
|     fn draw(&self, mem: &Param) -> Option<Vec<Point>> { | ||||
|         if self.cnt > self.borders.len() { | ||||
|         if self.cnt > self.borders.len() || self.finished { | ||||
|             return None; | ||||
|         } | ||||
|         if self.cnt == self.borders.len() { | ||||
| @ -126,19 +129,19 @@ impl Sequence for InitBorder { | ||||
|         let border_pt = get_intersection(&bords_pts); | ||||
|         mem.border_pt = bord_mult(border_pt, 1.1); | ||||
| 
 | ||||
|         //// on dessine le cadre
 | ||||
|         //let color: VecN<f64, 4> = VecN::new(255., 128., 0., 255.);
 | ||||
|         //let mut mixed = mix_borders(&background, borders)?;
 | ||||
|         //let b = &mem.border_pt;
 | ||||
|         //for i in 0..b.len() {
 | ||||
|         //    let j = (i + 1) % mem.border_pt.len();
 | ||||
|         //    let pa = VecN::from_array([b[i].0 as i32, b[i].1 as i32]);
 | ||||
|         //    let pb = VecN::from_array([b[j].0 as i32, b[j].1 as i32]);
 | ||||
|         //    let a = OcvPoint::from_vec2(pa);
 | ||||
|         //    let b = OcvPoint::from_vec2(pb);
 | ||||
|         //    line(&mut mixed, a, b, color, 1, LINE_AA, 0)?;
 | ||||
|         //}
 | ||||
|         //highgui::imshow("mixed bored", &mixed)?;
 | ||||
|         // on dessine le cadre
 | ||||
|         let color: VecN<f64, 4> = VecN::new(255., 128., 0., 255.); | ||||
|         let mut mixed = mix_borders(&background, borders)?; | ||||
|         let b = &mem.border_pt; | ||||
|         for i in 0..b.len() { | ||||
|             let j = (i + 1) % mem.border_pt.len(); | ||||
|             let pa = VecN::from_array([b[i].0 as i32, b[i].1 as i32]); | ||||
|             let pb = VecN::from_array([b[j].0 as i32, b[j].1 as i32]); | ||||
|             let a = OcvPoint::from_vec2(pa); | ||||
|             let b = OcvPoint::from_vec2(pb); | ||||
|             line(&mut mixed, a, b, color, 1, LINE_AA, 0)?; | ||||
|         } | ||||
|         highgui::imshow("mixed bored", &mixed)?; | ||||
| 
 | ||||
|         // on calcule l'homography
 | ||||
|         let size = mem.dst_size; | ||||
| @ -150,7 +153,7 @@ impl Sequence for InitBorder { | ||||
|             .map(|(x, y)| OcvPoint::new(*x as i32, *y as i32)) | ||||
|             .collect(); | ||||
|         //let dst = [(0, 0), (0, size), (size, size), (size, 0)]; // in: laser repere
 | ||||
|         let dst = [(0, size), (0, 0), (size, 0), (size, size)]; | ||||
|         let dst = [(size, size), (size, 0), (0, 0), (0, size)]; | ||||
|         let dst_corners: Vec<OcvPoint> = dst.iter().map(|(x, y)| OcvPoint::new(*x, *y)).collect(); | ||||
|         let roi_corners_mat = Mat::from_slice(&roi_corners[..])?; | ||||
|         let dst_corners_mat = Mat::from_slice(&dst_corners)?; | ||||
| @ -163,17 +166,17 @@ impl Sequence for InitBorder { | ||||
|         )?; //get homography
 | ||||
|         mem.homography = h.clone(); | ||||
|         mem.h_size = warped_image_size.clone(); | ||||
|         //let mut warped_image = Mat::default();
 | ||||
|         //imgproc::warp_perspective(
 | ||||
|         //    &mixed,
 | ||||
|         //    &mut warped_image,
 | ||||
|         //    &h,
 | ||||
|         //    warped_image_size,
 | ||||
|         //    imgproc::INTER_CUBIC, // I dont see difference with INTER_CUBIC
 | ||||
|         //    core::BORDER_CONSTANT,
 | ||||
|         //    Scalar::default(),
 | ||||
|         //)?; // do perspective transformation
 | ||||
|         //highgui::imshow("Warped Image", &warped_image)?;
 | ||||
|         let mut warped_image = Mat::default(); | ||||
|         imgproc::warp_perspective( | ||||
|             &mixed, | ||||
|             &mut warped_image, | ||||
|             &h, | ||||
|             warped_image_size, | ||||
|             imgproc::INTER_CUBIC, // I dont see difference with INTER_CUBIC
 | ||||
|             BORDER_CONSTANT, | ||||
|             Scalar::default(), | ||||
|         )?; // do perspective transformation
 | ||||
|         highgui::imshow("Warped Image", &warped_image)?; | ||||
|         self.finished = true; | ||||
|         Ok(()) | ||||
|     } | ||||
| @ -181,6 +184,14 @@ impl Sequence for InitBorder { | ||||
|     fn is_capture(&self) -> bool { | ||||
|         true | ||||
|     } | ||||
| 
 | ||||
|     fn sequence_name(&self) -> String { | ||||
|         "Init_Border".to_owned() | ||||
|     } | ||||
| 
 | ||||
|     fn wait_milis(&self) -> u64 { | ||||
|         self.nb_millis | ||||
|     } | ||||
| } | ||||
| 
 | ||||
| pub fn get_lines( | ||||
|  | ||||
| @ -2,7 +2,7 @@ use crate::{ | ||||
|     draw::draw_line_dotted, | ||||
|     point::Point, | ||||
|     qualibration::{ | ||||
|         annalyse::{get_horizontal_segment, image_diff}, | ||||
|         annalyse::{get_horizontal_segment, get_vertical_segment, image_diff}, | ||||
|         compute_image::{image_treshold, image_warp}, | ||||
|         param::Param, | ||||
|         Sequence, | ||||
| @ -29,15 +29,17 @@ pub struct InitIdcode { | ||||
|     cnt: usize, | ||||
|     beg: Point, | ||||
|     end: Point, | ||||
|     nb_millis: u64, | ||||
| } | ||||
| 
 | ||||
| impl InitIdcode { | ||||
|     pub fn new(beg: Point, end: Point) -> InitIdcode { | ||||
|     pub fn new(beg: Point, end: Point, nb_millis: u64) -> InitIdcode { | ||||
|         InitIdcode { | ||||
|             finished: false, | ||||
|             cnt: 0, | ||||
|             beg, | ||||
|             end, | ||||
|             nb_millis, | ||||
|         } | ||||
|     } | ||||
| } | ||||
| @ -99,7 +101,16 @@ impl Sequence for InitIdcode { | ||||
|         self.finished = true; | ||||
|         Ok(()) | ||||
|     } | ||||
| 
 | ||||
|     fn is_capture(&self) -> bool { | ||||
|         true | ||||
|     } | ||||
| 
 | ||||
|     fn sequence_name(&self) -> String { | ||||
|         "init_Id-Code".to_owned() | ||||
|     } | ||||
| 
 | ||||
|     fn wait_milis(&self) -> u64 { | ||||
|         self.nb_millis | ||||
|     } | ||||
| } | ||||
|  | ||||
| @ -1,11 +1,14 @@ | ||||
| use crate::point::{Color, Point}; | ||||
| use crate::qualibration::{ | ||||
|     annalyse::{ | ||||
|         draw_histograme_bgr_tresh, get_horizontal_segment, get_vertical_segment, histogram_3d, | ||||
|         image_diff, | ||||
| use crate::{ | ||||
|     point::{Color, Point}, | ||||
|     qualibration::{ | ||||
|         annalyse::{ | ||||
|             draw_histograme_bgr_tresh, get_horizontal_segment, get_vertical_segment, histogram_3d, | ||||
|             image_diff, | ||||
|         }, | ||||
|         compute_image::{image_treshold, image_warp}, | ||||
|         param::Param, | ||||
|         Sequence, | ||||
|     }, | ||||
|     param::Param, | ||||
|     Sequence, | ||||
| }; | ||||
| 
 | ||||
| use opencv::{ | ||||
| @ -20,6 +23,7 @@ opencv::opencv_branch_4! { | ||||
| } | ||||
| opencv::not_opencv_branch_4! { | ||||
|     use opencv::core::LINE_AA; | ||||
|     use opencv::imgproc::LINE_8; | ||||
| } | ||||
| 
 | ||||
| #[derive(Debug, Clone)] | ||||
| @ -30,10 +34,12 @@ pub struct LineDotted { | ||||
|     end: Point, | ||||
|     continuous_y: bool, | ||||
|     continuous_x: bool, | ||||
|     nb_millis: u64, | ||||
|     factor: usize, | ||||
| } | ||||
| 
 | ||||
| impl LineDotted { | ||||
|     pub fn new(beg: Point, end: Point, continuous_y: bool, continuous_x: bool) -> Self { | ||||
|     pub fn new(beg: Point, end: Point, factor: usize, continuous_y: bool, continuous_x: bool, nb_millis: u64) -> Self { | ||||
|         Self { | ||||
|             finished: false, | ||||
|             cnt: 0, | ||||
| @ -41,6 +47,8 @@ impl LineDotted { | ||||
|             end, | ||||
|             continuous_x, | ||||
|             continuous_y, | ||||
|             factor, | ||||
|             nb_millis, | ||||
|         } | ||||
|     } | ||||
| } | ||||
| @ -55,36 +63,47 @@ impl Sequence for LineDotted { | ||||
|         } | ||||
|         let nb_all = mem.nb_all; | ||||
|         let nb_wait = mem.nb_wait as usize; | ||||
|         let nb_visible = mem.nb_visible as usize; | ||||
|         //let nb_visible = mem.nb_visible as usize;
 | ||||
|         let len = (self.factor * mem.line_pos.len() + nb_wait) as f32; | ||||
|         let mut pl = vec![]; | ||||
|         let black = Color { r: 0, g: 0, b: 0 }; | ||||
|         let color = Color { | ||||
|             r: mem.r as u8, | ||||
|             g: mem.g as u8, | ||||
|             b: mem.b as u8, | ||||
|         }; | ||||
|         let black = Color { r: 0, g: 0, b: 0 }; | ||||
| 
 | ||||
|         // go to firsst point
 | ||||
|         for _ in 0..nb_all { | ||||
|             pl.push(Point { | ||||
|                 color: black, | ||||
|                 ..self.beg | ||||
|             }); | ||||
|         } | ||||
|         let len = (2 * mem.line_pos.len() + nb_wait) as f32; | ||||
| 
 | ||||
|         // go on the continus_axes in black to gain speed
 | ||||
|         for i in 0..nb_wait { | ||||
|             let val_x = i as f32 / len * (self.end.x - self.beg.x) + self.beg.x; | ||||
|             let val_y = i as f32 / len * (self.end.y - self.beg.y) + self.beg.y; | ||||
|             let val_x = self.end.x;//i as f32 / len * (self.end.x - self.beg.x) + self.beg.x;
 | ||||
|             let val_y = self.end.y;//i as f32 / len * (self.end.y - self.beg.y) + self.beg.y;
 | ||||
|             pl.push(Point { | ||||
|                 x: if self.continuous_x { val_x } else { self.beg.x }, | ||||
|                 y: if self.continuous_y { val_y } else { self.beg.y }, | ||||
|                 color: black, | ||||
|             }); | ||||
|         } | ||||
|         for i in 0..(mem.line_pos.len() * 2) { | ||||
| 
 | ||||
|         // donne each pose lavue acording to the slide bar value and the continus axes
 | ||||
|         for i in 0..(mem.line_pos.len() * self.factor) { | ||||
|             let val_cont_x = (i + nb_wait) as f32 / len * (self.end.x - self.beg.x) + self.beg.x; | ||||
|             let val_cont_y = (i + nb_wait) as f32 / len * (self.end.y - self.beg.y) + self.beg.y; | ||||
|             let val_x = mem.line_pos[i / 2] as f32 + self.beg.x; | ||||
|             let val_y = mem.line_pos[i / 2] as f32 + self.beg.y; | ||||
|             let is_visible = (i + nb_wait) % 2 == 0 && i < nb_visible; | ||||
|             let val_x = mem.line_pos[i / self.factor] as f32 + self.beg.x; | ||||
|             let val_y = mem.line_pos[i / self.factor] as f32 + self.beg.y; | ||||
|             //let is_visible = (i + nb_wait) % 2 == 0;// && i < nb_visible;
 | ||||
|             let is_visible = match (self.cnt, i) { | ||||
|                 (1, _) => true, | ||||
|                 (2, i) => i & 1 == 0, | ||||
|                 (cnt, i) => i & (1 << (cnt - 3)) != 0, | ||||
|             }; | ||||
|             let c = if is_visible { color } else { black }; | ||||
|             pl.push(Point { | ||||
|                 x: if self.continuous_x { val_cont_x } else { val_x }, | ||||
| @ -97,52 +116,37 @@ impl Sequence for LineDotted { | ||||
|     } | ||||
| 
 | ||||
|     fn compute_sequence(&mut self, mem: &mut Param) -> Result<(), Box<dyn std::error::Error>> { | ||||
|         if self.cnt < 1 { | ||||
|         if self.cnt <= ((self.factor * mem.line_pos.len()) as f64).log2() as usize + 2 { | ||||
|             self.cnt += 1; | ||||
|             return Ok(()) | ||||
|         } | ||||
|         let ids = mem.seq_id; | ||||
|         let background = mem.imgs[ids][0].to_owned(); | ||||
|         let line_dot = mem.imgs[ids][1].to_owned(); | ||||
|         let diff = image_diff(&background, &line_dot)?; | ||||
|             //let len = ((self.factor * mem.line_pos.len()) as f64).log2() as usize + 1;
 | ||||
| 
 | ||||
|         let mut warped_image = Mat::default(); | ||||
|         imgproc::warp_perspective( | ||||
|             &diff, | ||||
|             &mut warped_image, | ||||
|             &mem.homography, | ||||
|             mem.h_size, | ||||
|             imgproc::INTER_CUBIC, // I dont see difference with INTER_CUBIC
 | ||||
|             BORDER_CONSTANT, | ||||
|             Scalar::default(), | ||||
|         )?; | ||||
|         //highgui::imshow("Warped Image", &warped_image)?;
 | ||||
|         //if self.cnt > ((self.factor * mem.line_pos.len()) as f64).log2() as usize + 1 {
 | ||||
|         //    if mem.capture_mode {
 | ||||
|         //        self.finished = true;
 | ||||
|         //    } else {
 | ||||
|         //        self.cnt = 0;
 | ||||
|         //    }
 | ||||
|         //    return Ok(())
 | ||||
|         //}
 | ||||
|         //println!("Groboulli: {}", line!());
 | ||||
|         let ids = mem.seq_id; | ||||
|         let img_len = mem.imgs[ids].len(); | ||||
|         let img_id = 2;//(img_len-1).min(self.cnt);
 | ||||
| 
 | ||||
|         let background = mem.imgs[ids][0].to_owned(); | ||||
|         let line_dot = mem.imgs[ids][img_id].to_owned(); | ||||
|         let diff = image_diff(&line_dot, &background)?; | ||||
|         //highgui::imshow("lone dotted", &diff)?;
 | ||||
| 
 | ||||
|         let warped_image = image_warp(&diff, &mem.homography, mem.h_size)?; | ||||
|         let mut bord_treshed = image_treshold(&warped_image, &mem.tresh)?; | ||||
|         highgui::imshow("Warped and treshed Image", &bord_treshed)?; | ||||
| 
 | ||||
|         let histo = histogram_3d(&warped_image, mem.nb_liss)?; | ||||
|         draw_histograme_bgr_tresh("histo bgr", &histo, &mem.tresh)?; | ||||
| 
 | ||||
|         let (t1, s1, l1) = ( | ||||
|             mem.tresh.min_0 as f64, | ||||
|             mem.tresh.min_1 as f64, | ||||
|             mem.tresh.min_2 as f64, | ||||
|         ); | ||||
|         let (t2, s2, l2) = ( | ||||
|             mem.tresh.max_0 as f64, | ||||
|             mem.tresh.max_1 as f64, | ||||
|             mem.tresh.max_2 as f64, | ||||
|         ); | ||||
|         let min = Mat::from_slice(&[t1, s1, l1])?; | ||||
|         let max = Mat::from_slice(&[t2, s2, l2])?; | ||||
|         let mut color_selected = Mat::default(); | ||||
|         let _ = in_range(&warped_image, &min, &max, &mut color_selected); | ||||
|         let mut bord_treshed = Mat::default(); | ||||
|         bitwise_and( | ||||
|             &warped_image, | ||||
|             &warped_image, | ||||
|             &mut bord_treshed, | ||||
|             &color_selected, | ||||
|         )?; | ||||
|         //highgui::imshow(format!("warped_image & mask").as_str(), &bord_treshed)?;
 | ||||
| 
 | ||||
|         let segments = if self.continuous_y { | ||||
|             get_vertical_segment(&bord_treshed)? | ||||
|         } else { | ||||
| @ -158,10 +162,18 @@ impl Sequence for LineDotted { | ||||
|             line(&mut bord_treshed, a, b, color, 1, LINE_8, 0)?; | ||||
|         } | ||||
|         highgui::imshow("segemnt detector", &bord_treshed)?; | ||||
|         self.cnt += 1; | ||||
|         self.finished = true; | ||||
|         Ok(()) | ||||
|     } | ||||
|     fn is_capture(&self) -> bool { | ||||
|         true | ||||
|     } | ||||
|     fn sequence_name(&self) -> String { | ||||
|         "line_Dotted".to_owned() | ||||
|     } | ||||
| 
 | ||||
|     fn wait_milis(&self) -> u64 { | ||||
|         self.nb_millis | ||||
|     } | ||||
| } | ||||
|  | ||||
| @ -5,11 +5,12 @@ use opencv::Result; | ||||
| #[derive(Debug, Clone, Copy)] | ||||
| pub struct LoadImage { | ||||
|     finished: bool, | ||||
|     nb_millis: u64, | ||||
| } | ||||
| 
 | ||||
| impl LoadImage { | ||||
|     pub fn new() -> LoadImage { | ||||
|         LoadImage { finished: false } | ||||
|         LoadImage { finished: false, nb_millis: 0 } | ||||
|     } | ||||
| } | ||||
| 
 | ||||
| @ -20,6 +21,7 @@ impl Sequence for LoadImage { | ||||
|         } | ||||
|         Some(vec![]) | ||||
|     } | ||||
| 
 | ||||
|     fn compute_sequence(&mut self, mem: &mut Param) -> Result<(), Box<dyn std::error::Error>> { | ||||
|         if !mem.capture_mode { | ||||
|             mem.load_image()?; | ||||
| @ -27,7 +29,16 @@ impl Sequence for LoadImage { | ||||
|         self.finished = true; | ||||
|         Ok(()) | ||||
|     } | ||||
| 
 | ||||
|     fn is_capture(&self) -> bool { | ||||
|         false | ||||
|     } | ||||
| 
 | ||||
|     fn sequence_name(&self) -> String { | ||||
|         "Load_Image".to_owned() | ||||
|     } | ||||
| 
 | ||||
|     fn wait_milis(&self) -> u64 { | ||||
|         self.nb_millis | ||||
|     } | ||||
| } | ||||
|  | ||||
| @ -5,11 +5,12 @@ use opencv::Result; | ||||
| #[derive(Debug, Clone, Copy)] | ||||
| pub struct SaveImage { | ||||
|     finished: bool, | ||||
|     nb_millis: u64, | ||||
| } | ||||
| 
 | ||||
| impl SaveImage { | ||||
|     pub fn new() -> SaveImage { | ||||
|         SaveImage { finished: false } | ||||
|         SaveImage { finished: false, nb_millis: 0} | ||||
|     } | ||||
| } | ||||
| 
 | ||||
| @ -20,12 +21,22 @@ impl Sequence for SaveImage { | ||||
|         } | ||||
|         Some(vec![]) | ||||
|     } | ||||
| 
 | ||||
|     fn compute_sequence(&mut self, mem: &mut Param) -> Result<(), Box<dyn std::error::Error>> { | ||||
|         mem.save_image()?; | ||||
|         self.finished = true; | ||||
|         Ok(()) | ||||
|     } | ||||
| 
 | ||||
|     fn is_capture(&self) -> bool { | ||||
|         false | ||||
|     } | ||||
| 
 | ||||
|     fn sequence_name(&self) -> String { | ||||
|         "Save_Image".to_owned() | ||||
|     } | ||||
| 
 | ||||
|     fn wait_milis(&self) -> u64 { | ||||
|         self.nb_millis | ||||
|     } | ||||
| } | ||||
|  | ||||
| @ -9,16 +9,13 @@ use opencv::Result; | ||||
| #[derive(Debug, Clone, Copy)] | ||||
| pub struct WaitSpace { | ||||
|     borders: [Point; 4], | ||||
|     red: [Point; 2], | ||||
|     green: [Point; 2], | ||||
|     blue: [Point; 2], | ||||
|     mid: [Point; 2], | ||||
|     nb_millis: u64, | ||||
| } | ||||
| 
 | ||||
| impl WaitSpace { | ||||
|     pub fn new(beg: Point, end: Point) -> Self { | ||||
|         let red_y = (end.y - beg.y) * 1./5. + beg.y; | ||||
|         let green_y = (end.y - beg.y) * 2./5. + beg.y; | ||||
|         let blue_y = (end.y - beg.y) * 3./5. + beg.y; | ||||
|     pub fn new(beg: Point, end: Point, nb_millis: u64) -> Self { | ||||
|         let mid = (end.y - beg.y) * 0.5 + beg.y; | ||||
|         Self { | ||||
|             borders: [ | ||||
|                 Point { | ||||
| @ -42,42 +39,19 @@ impl WaitSpace { | ||||
|                     color: end.color, | ||||
|                 }, | ||||
|             ], | ||||
|             red: [ | ||||
|             mid: [ | ||||
|                 Point { | ||||
|                     x: beg.x, | ||||
|                     y: red_y, | ||||
|                     y: mid, | ||||
|                     color: end.color, | ||||
|                 }, | ||||
|                 Point { | ||||
|                     x: end.x, | ||||
|                     y: red_y, | ||||
|                     color: end.color, | ||||
|                 }, | ||||
|             ], | ||||
|             blue: [ | ||||
|                 Point { | ||||
|                     x: beg.x, | ||||
|                     y: blue_y, | ||||
|                     color: end.color, | ||||
|                 }, | ||||
|                 Point { | ||||
|                     x: end.x, | ||||
|                     y: blue_y, | ||||
|                     color: end.color, | ||||
|                 }, | ||||
|             ], | ||||
|             green: [ | ||||
|                 Point { | ||||
|                     x: beg.x, | ||||
|                     y: green_y, | ||||
|                     color: end.color, | ||||
|                 }, | ||||
|                 Point { | ||||
|                     x: end.x, | ||||
|                     y: green_y, | ||||
|                     y: mid, | ||||
|                     color: end.color, | ||||
|                 }, | ||||
|             ], | ||||
|             nb_millis, | ||||
|         } | ||||
|     } | ||||
| } | ||||
| @ -94,21 +68,6 @@ impl Sequence for WaitSpace { | ||||
|             g: mem.g as u8, | ||||
|             b: mem.b as u8, | ||||
|         }; | ||||
|         let red = Color { | ||||
|             r: mem.r as u8, | ||||
|             g: 0, | ||||
|             b: 0, | ||||
|         }; | ||||
|         let green = Color { | ||||
|             r: 0, | ||||
|             g: mem.g as u8, | ||||
|             b: 0, | ||||
|         }; | ||||
|         let blue = Color { | ||||
|             r: 0, | ||||
|             g: 0, | ||||
|             b: mem.b as u8, | ||||
|         }; | ||||
|         for i in 0..self.borders.len() { | ||||
|             let id1 = (i + 1) % self.borders.len(); | ||||
|             let p0 = Point { | ||||
| @ -126,44 +85,18 @@ impl Sequence for WaitSpace { | ||||
|                 mem.nb_visible as usize, | ||||
|             )); | ||||
|             pl.extend(draw_line_dotted( | ||||
|                 &Point{ | ||||
|                     color: blue, | ||||
|                     ..self.blue[0] | ||||
|                 &Point { | ||||
|                     color, | ||||
|                     ..self.mid[0] | ||||
|                 }, | ||||
|                 &Point{ | ||||
|                     color: blue, | ||||
|                     ..self.blue[1] | ||||
|                 &Point { | ||||
|                     color, | ||||
|                     ..self.mid[1] | ||||
|                 }, | ||||
|                 mem.nb_all as usize, | ||||
|                 mem.nb_visible as usize, | ||||
|                 true, | ||||
|                     )); | ||||
|             pl.extend(draw_line_dotted( | ||||
|                 &Point{ | ||||
|                     color: green, | ||||
|                     ..self.green[0] | ||||
|                 }, | ||||
|                 &Point{ | ||||
|                     color: green, | ||||
|                     ..self.green[1] | ||||
|                 }, | ||||
|                 mem.nb_all as usize, | ||||
|                 mem.nb_visible as usize, | ||||
|                 true, | ||||
|                     )); | ||||
|             pl.extend(draw_line_dotted( | ||||
|                 &Point{ | ||||
|                     color: red, | ||||
|                     ..self.red[0] | ||||
|                 }, | ||||
|                 &Point{ | ||||
|                     color: red, | ||||
|                     ..self.red[1] | ||||
|                 }, | ||||
|                 mem.nb_all as usize, | ||||
|                 mem.nb_visible as usize, | ||||
|                 true, | ||||
|                     )); | ||||
|             )); | ||||
|         } | ||||
|         Some(pl) | ||||
|     } | ||||
| @ -173,4 +106,12 @@ impl Sequence for WaitSpace { | ||||
|     fn is_capture(&self) -> bool { | ||||
|         false | ||||
|     } | ||||
| 
 | ||||
|     fn sequence_name(&self) -> String { | ||||
|         "Wait_Space".to_owned() | ||||
|     } | ||||
| 
 | ||||
|     fn wait_milis(&self) -> u64 { | ||||
|         self.nb_millis | ||||
|     } | ||||
| } | ||||
|  | ||||
		Loading…
	
	
			
			x
			
			
		
	
		Reference in New Issue
	
	Block a user