GODOT IS OPEN SOURCE

1 files changed, 574 insertions, 0 deletions

diff --git a/drivers/chibi/cp_pattern.cpp b/drivers/chibi/cp_pattern.cpp
new file mode 100644
index 0000000000..b880071cca
--- /dev/null
+++ b/drivers/chibi/cp_pattern.cpp
@@ -0,0 +1,574 @@
+/*************************************************************************/
+/*  cp_pattern.cpp                                                       */
+/*************************************************************************/
+/*                       This file is part of:                           */
+/*                           GODOT ENGINE                                */
+/*                    http://www.godotengine.org                         */
+/*************************************************************************/
+/* Copyright (c) 2007-2014 Juan Linietsky, Ariel Manzur.                 */
+/*                                                                       */
+/* Permission is hereby granted, free of charge, to any person obtaining */
+/* a copy of this software and associated documentation files (the       */
+/* "Software"), to deal in the Software without restriction, including   */
+/* without limitation the rights to use, copy, modify, merge, publish,   */
+/* distribute, sublicense, and/or sell copies of the Software, and to    */
+/* permit persons to whom the Software is furnished to do so, subject to */
+/* the following conditions:                                             */
+/*                                                                       */
+/* The above copyright notice and this permission notice shall be        */
+/* included in all copies or substantial portions of the Software.       */
+/*                                                                       */
+/* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,       */
+/* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF    */
+/* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.*/
+/* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY  */
+/* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,  */
+/* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE     */
+/* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.                */
+/*************************************************************************/
+#include "cp_pattern.h"
+
+void CPPattern::clear() {
+
+	if (event_count>0) {
+		
+		
+		CP_FREE(events);
+		events=NULL;
+		event_count=0;		
+	}
+
+	length=DEFAULT_LEN;
+	
+}
+
+
+bool CPPattern::resize_event_list_to(uint32_t p_events) {
+	
+
+	//Module is slow in some cpus, so this should be fast enough
+	uint32_t new_size=((p_events-1)&(~((1<<RESIZE_EVERY_BITS)-1)))+(1<<RESIZE_EVERY_BITS);
+	
+	CP_ERR_COND_V(new_size<p_events,true); //bugARM_INFO
+	
+	if (event_count==0 && new_size==0)
+		return false; //nothing to do
+	
+	if (event_count==0) {
+		
+		events=(Event*)CP_ALLOC( new_size*sizeof(Event) );
+
+	} else if (new_size==0) {
+		
+		CP_FREE(events);
+		events=NULL;
+	} else {
+		
+		CP_ERR_COND_V(events==NULL,true);
+		events=(Event*)CP_REALLOC(events, new_size*sizeof(Event));
+
+	}
+	
+	event_count=p_events;
+	
+	return false;
+}
+
+
+int32_t CPPattern::get_event_pos(uint16_t p_target_pos) {
+	
+	
+	if (event_count==0)
+		return -1;
+	
+	int low = 0;
+	int high = event_count -1;
+	int middle;
+	
+	while( low <= high )
+	{
+		middle = ( low  + high ) / 2;
+
+		if( p_target_pos == events[middle].pos ) { //match
+			break;
+		} else if( p_target_pos < events[middle].pos )
+			high = middle - 1; //search low end of array
+		else
+			low = middle + 1; //search high end of array
+	}
+
+	/* adapt so we are behind 2 */
+
+	if (events[middle].pos<p_target_pos)
+		middle++;
+	return middle;
+	
+	/* Linear search for now */
+
+	/*
+	int32_t pos_idx=0;
+		
+	for (;pos_idx<event_count;pos_idx++) {
+		
+		if (event_list[pos_idx].pos>=p_target_pos)
+			break;
+		
+	} */
+	
+	//return pos_idx;
+}
+
+bool CPPattern::erase_event_at_pos(uint16_t p_pos) {
+	
+	if (event_count==0)
+		return false;
+	
+
+	
+	Event *event_list=events;
+
+	int32_t pos_idx = get_event_pos(p_pos);
+	if (pos_idx==-1) {
+		CP_ERR_COND_V(pos_idx==-1,true);				
+	}
+	
+	if (pos_idx==event_count || event_list[pos_idx].pos!=p_pos) {
+		/* Nothing to Erase */
+		return false;
+	}
+	
+	for (int32_t i=pos_idx;i<(event_count-1);i++) {
+		
+		event_list[i]=event_list[i+1];
+	}
+	
+
+	resize_event_list_to(event_count-1); 
+	
+	return false;
+}
+
+bool CPPattern::set_note(uint8_t p_column, uint16_t p_row,const CPNote& p_note) {
+
+	CP_ERR_COND_V(p_column>=WIDTH,true);
+	CP_ERR_COND_V(p_row>=length,true);
+	
+	int32_t new_pos;
+	uint16_t target_pos=p_row*WIDTH+p_column;
+	
+
+	
+	if (p_note.is_empty()) {
+		bool res=erase_event_at_pos(target_pos);
+
+		return res;;
+	}
+	
+	Event *event_list=0;
+	
+	if (event_count==0) {
+		/* If no events, create the first */
+		
+		if (resize_event_list_to(1)) {
+
+			CP_PRINTERR("Can't resize event list to 1");
+			return true;
+		}
+
+		event_list=events;
+		if (event_list==0) {
+			
+
+			CP_PRINTERR("Can't get event list");
+			return true;
+		}
+		
+		new_pos=0;				
+		
+	} else {
+		/* Prepare to add */
+		
+		event_list=events;
+		if (event_list==0) {
+			
+
+			CP_PRINTERR("Can't get event list");
+			return true;
+		}
+		
+		int32_t pos_idx = get_event_pos(target_pos);
+		
+		if (pos_idx==-1) {
+
+
+			CP_PRINTERR("Can't find add position");
+			return true;
+		}
+			
+		
+		if (pos_idx==event_count || event_list[pos_idx].pos!=target_pos) { 
+			/* If the note being modified didnt exist, then we add it */
+
+			//resize, and return if out of mem
+			if (resize_event_list_to( event_count+1)) {
+				
+
+				CP_PRINTERR("Can't resize event list");
+				return true;
+			}
+			event_list=events;
+			if (event_list==0) {
+				
+
+				CP_PRINTERR("Can't get event list");
+				return true;
+			}
+			
+			//make room for new pos, this wont do a thing if pos_idx was ==event_count
+			for(int32_t i=(event_count-1);i>pos_idx;i--) {
+				event_list[i]=event_list[i-1];
+				
+			}
+			
+		} /* Else it means that position is taken, so we just modify it! */
+		
+				  
+		new_pos=pos_idx;
+	}
+	
+	event_list[new_pos].pos=target_pos;
+	event_list[new_pos].note=p_note.note;
+	event_list[new_pos].instrument=p_note.instrument;
+	event_list[new_pos].volume=p_note.volume;
+	event_list[new_pos].command=p_note.command;
+	event_list[new_pos].parameter=p_note.parameter;
+	event_list[new_pos].script_source_sign=p_note.script_source_sign;
+	event_list[new_pos].cloned=p_note.cloned;
+	
+
+	
+
+	return false;
+	
+}
+CPNote CPPattern::get_note(uint8_t p_column,uint16_t  p_row) {
+
+	if (p_column==CPNote::EMPTY) return CPNote();
+    
+	CP_ERR_COND_V(p_column>=WIDTH,CPNote());
+	CP_ERR_COND_V(p_row>=length,CPNote());
+
+	if (event_count==0)
+		return CPNote();
+	
+
+	Event *event_list=events;
+	
+	CP_ERR_COND_V(event_list==0,CPNote());
+	
+	uint16_t target_pos=p_row*WIDTH+p_column;
+	int32_t pos_idx = get_event_pos(target_pos);
+	if (pos_idx==-1) {	
+
+		CP_PRINTERR("Can't find event pos");
+		return CPNote();
+	}
+	
+	if (pos_idx>=event_count || event_list[pos_idx].pos!=target_pos) {
+		/* no note found */
+
+		return CPNote();
+	}
+	
+	CPNote n;
+	n.note=event_list[pos_idx].note;
+	n.instrument=event_list[pos_idx].instrument;
+	n.volume=event_list[pos_idx].volume;
+	n.command=event_list[pos_idx].command;
+	n.parameter=event_list[pos_idx].parameter;
+	n.script_source_sign=event_list[pos_idx].script_source_sign;
+	n.cloned=event_list[pos_idx].cloned;
+	
+
+	return n;
+	
+}
+
+CPNote CPPattern::get_transformed_script_note(uint8_t p_column,uint16_t p_row ) {
+	
+	CPNote n = get_note( p_column, p_row );
+	
+	// get source channel and note
+	
+	int channel = get_scripted_note_target_channel( p_column, p_row );
+	CPNote src_n = get_note( channel, 0 );
+	
+	if ( src_n.note == CPNote::SCRIPT ) return CPNote();
+	
+	script_transform_note( src_n, n );
+	
+	return src_n;
+	
+}
+
+int CPPattern::get_scripted_note_target_channel(uint8_t p_column, uint16_t p_row) {
+	
+	CPNote n = get_note( p_column, p_row );
+	
+	if ( n.note != CPNote::SCRIPT ) return CPNote::EMPTY;
+	
+	int channel = n.instrument;
+	
+	if ( n.script_source_sign == '\0' ) {
+		
+	    if ( channel < 0 || channel >= CPPattern::WIDTH ) return CPNote::EMPTY;
+	
+	} else {
+	    
+	    channel = p_column + ( ( n.script_source_sign=='+') ? 1 : -1 ) * (channel+1);
+	    if ( channel < 0 || channel >= CPPattern::WIDTH ) return CPNote::EMPTY;
+	    
+	}
+	
+	return channel;
+}
+
+void CPPattern::scripted_clone(uint8_t p_column, uint16_t p_row) {
+	
+	int channel = get_scripted_note_target_channel( p_column, p_row );
+	int src_row = 1;
+	CPNote script_n = get_note( p_column, p_row );
+	
+	for ( int row = p_row+1; row < length; ++row ) {
+	    
+	    CPNote src_n = get_note( channel, src_row );
+	    CPNote target_n = get_note( p_column, row );
+	    
+	    if ( target_n.note != CPNote::SCRIPT ) {
+		if ( src_n.note == CPNote::SCRIPT ) {
+		    src_n = CPNote();
+		    channel = CPNote::EMPTY;
+		}
+		
+		script_transform_note( src_n, script_n );
+		
+		src_n.cloned = true;
+		set_note( p_column, row, src_n );
+		
+	    } else {
+		
+		return;
+		
+	    }
+	    
+	    src_row++;
+	}
+	
+}
+
+void CPPattern::scripted_clone_remove(uint8_t p_column, uint16_t p_row) {
+	
+	if ( get_note( p_column, p_row ).cloned )
+	    set_note( p_column, p_row, CPNote() );
+	
+	for ( int row = p_row+1; row < length; ++row ) {
+	    
+	    CPNote target_n = get_note( p_column, row );
+	    
+	    if ( target_n.note != CPNote::SCRIPT ) {
+		
+		set_note( p_column, row, CPNote() );
+		
+	    } else {
+		
+		return;
+		
+	    }
+	    
+	}
+	
+}
+
+void CPPattern::script_transform_note(CPNote& n, const CPNote& p_note) {
+	
+	// set instrument
+	
+	if ( n.note < CPNote::NOTES && p_note.volume != CPNote::EMPTY ) {
+	    
+	    n.instrument = p_note.volume;
+	    
+	}
+	
+	// transpose
+	
+	if ( n.note < CPNote::NOTES && p_note.command != CPNote::EMPTY ) {
+	    
+	    int transpose = ( p_note.parameter & 0xF ) + ( p_note.parameter / 0x10 ) * 12;
+	    
+	    if ( p_note.command == '^' ) {
+		
+		if ( n.note >= CPNote::NOTES-transpose )
+		    n.note = CPNote::NOTES-1;
+		else
+		    n.note += transpose;
+		
+	    } else if ( p_note.command == 'v' ) {
+		
+		if ( n.note <= transpose )
+		    n.note = 0;
+		else
+		    n.note -= transpose;
+		
+	    }
+	}
+	
+}
+
+bool CPPattern::update_scripted_clones_sourcing_channel( int channel ) {
+    
+    bool updated = false;
+    
+    for ( int x = 0; x < WIDTH; ++x ) {
+	
+	for (int y = 0; y < length; ++y ) {
+	    
+	    if ( channel == get_scripted_note_target_channel( x, y ) ) {
+		
+		scripted_clone( x, y );
+		updated = true;
+	    }
+	    
+	}
+	
+    }
+    
+    return updated;
+}
+
+void CPPattern::set_length(uint16_t p_rows) {
+	
+
+	
+	if (event_count==0) {
+		
+		if (p_rows>=MIN_ROWS)
+			length=p_rows;
+
+			
+		return;	
+		
+	}
+	
+	if (p_rows<MIN_ROWS) {
+
+		return;
+	}
+	
+	if (p_rows<length) {
+			
+		Event* event_list=events;
+		if (event_list==0) {
+
+			CP_PRINTERR("get_event_list() Failed");
+			return;
+		}
+			
+
+		uint16_t target_pos=p_rows*WIDTH;
+		int32_t pos_idx = get_event_pos(target_pos);
+
+		
+		if (pos_idx==-1) {
+
+			CP_ERR_COND(pos_idx==-1);				
+		}
+			
+		if (resize_event_list_to(pos_idx)) {
+
+			CP_PRINTERR("resize_event_list_to(pos_idx) Failed");
+			return;
+		}
+		
+	}
+	
+	length=p_rows;
+
+	
+}
+#if 0
+void CPPattern::copy_to(CPPattern *p_pattern) const {
+	
+	
+	
+	
+	p_pattern->clear();
+	p_pattern->length=length;
+	
+	
+	if (!event_count)
+		return;
+	
+
+	
+	int bufsiz=MemPool_Wrapper::get_singleton()->get_mem_size( mem_handle );
+	MemPool_Handle aux_mem_handle=MemPool_Wrapper::get_singleton()->alloc_mem( bufsiz );
+	
+	if (aux_mem_handle.is_null()) {
+		
+		CP_PRINTERR("own handle is null");
+
+		return;		
+	}
+			
+	
+	if (MemPool_Wrapper::get_singleton()->lock_mem(aux_mem_handle)) {
+		CP_PRINTERR("Unable to lock aux new handle");		
+
+		return;
+		
+	}
+	
+	if (MemPool_Wrapper::get_singleton()->lock_mem(mem_handle)) {
+		
+		CP_PRINTERR("Unable to lock own handle");
+
+		return;
+	}
+	
+	uint8_t* srcuint8_tt8_t*)MemPool_Wrapper::get_singleton()->get_mem(mem_handle);
+	uint8_t* dstuint8_tt8_t*)MemPool_Wrapper::get_singleton()->get_mem(aux_mem_handle);
+	
+	for (int i=0;i<bufsiz;i++) 
+		dst[i]=src[i];
+	
+	MemPool_Wrapper::get_singleton()->unlock_mem(mem_handle);
+	MemPool_Wrapper::get_singleton()->unlock_mem(aux_mem_handle);
+	
+	p_pattern->mem_handle=aux_mem_handle;
+	p_pattern->event_count=event_count;
+	
+
+}
+#endif
+uint16_t CPPattern::get_length() {
+	
+	
+	return length;
+}
+CPPattern::CPPattern() {
+	
+	
+	length=DEFAULT_LEN;
+	event_count=0;
+	clear();
+	
+}
+bool CPPattern::is_empty() {
+	
+	return events==NULL;
+}
+
+CPPattern::~CPPattern() {
+	
+	clear();
+}